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PREFACE 

This  thesis  describes  a  procedure  for  micro-stepping  a 
stepper  motor  and  how  it  was  set  up,  tested,  and  verified. 
It  also  presents  a  strategy  used  to  control  the  movement  of  a 
weight  on  the  end  of  a  flexible  link.  The  control  strategy 
seeks  to  cause  the  the  weight  to  follow  a  predetermined 
movement  as  closely  as  possible.  The  reasons  for  using  a 
micro-stepper  to  drive  the  link  are  presented.  Conclusions 
and  suggestions  for  further  study  are  presented  for  both  the 
hardware  and  the  software. 

I  would  like  to  thank  Dr.  J.  Garth  Thompson  and  Dr.  Chi 
L.  Huang  for  helping  me  model  the  system.  I  would  also  like 
to  thank  Mr.  Kent  Funk  for  answers  to  some  late  night 
questions  and  his  help  on  the  hardware  aspect  of  the  project. 
I  would  especially  like  to  thank  my  wife,  Deborah,  for  her 
support. 
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CHAPTER    I 

1.  INTRODUCTION 

The  primary  purpose  of  this  research  is  to  develop  a 
control  system  for  angular  movements  of  a  flexible  link  with 
a  mass  on  the  end.  The  secondary  objective  is  to  improve  the 
accuracy  and  resolution  of  a  stepper  motor  that  is  used  as 
the  actuator  of  the  flexible  link. 

The  goals  of  this  project  are  as  follows: 

(1)  Produce  a  micro-stepper  logic  circuit  to 
improve  the  resolution  of  the  stepper  motor 

(2)  Configure  a  computer  system  for  operation  of 
the  micro— stepper  circuit,  control  of  the 
link,  and  data  acquisition  for  the  project 

(3)  Develop  signal  processing  and  control 
algorithms  for  feedback  atnd  control  for  the 
movement  of  the  link 

(4)  Test  and  evaluate  the  effectiveness  of  the 
control  strategy  and  the  micro-stepper 

2.  SYSTEM  DESCRIPTION 

The  flexible  link  that  is  controlled  consists  of  a  .292  rn 
strip  of  spring  steel  with  a  .95  cm  by  .08  cm  cross  section  and 
with  a  200  gm  mass  attached  to  one  end  of  the  strip.  The  other 
end  of  the  strip  is  connected  to  the  shaft  of  the  actuator 
(steppei — motor).  Figure  1.1  illustrates  the  system.  The  reason 
for  using  a  flexible  link  is  to  reduce  mass.  P  manipulator  arm 
on  a  space  craft  is  s^ri  example  where  mass  is  a  prime  concern. 
For  this  project,  a  flexible  link  with  a  large  period  was 
selected  to  allow  ample  time  for  sampling  the  feedback  signal  and 
to  compute  the  control  signal. 


Flexible 
Link 


Attached 
Mass 
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Figure  1. 1     Actuator  and  Flexible  Link  with  Attached  Mass 

A  stepper  motor  is  used  to  drive  the  flexible  link 
through  ar\  angular  displacement.  The  stepper  motor  is  of  the 
SIGMA  series  £00  (model  #£0-££35D£00-f 3. 7) .  The  stepper 
motor  has  £00  steps  per  revolution  in  the  full  step  mode  or 
400  steps  per  revolution  in  the  half  step  mode.  The 
characteristics  of  the  system  to  be  controlled  will  be 
developed  in  the  next  section. 

3.   DYNAMIC  MODEL 

The  deflection  of  the  flexible  link  during  angular 
displacement  is  found  from  the  formula  for  deflection  of 
cantilever  beams: 


1 
R 


_M_ 
EI 


(1) 


where: 

R  is  radius  of  curvature 

M  is  the  bending  moment  and  is  a  function  of  x 
E  is  the  rnodulas  of  elasticity,  and 

I  is  the  cross  sectional  moment  of  inertia  of  the  link. 
The  inertia  and  flexural  rigidity  are    as  follows: 
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where: 

b 

= 

.  08  cm 

h 

= 

.  95  cm 

-13   4 

I 

= 

3.  9695 

X 

10     m 
11     2 

E 

= 

2. 0537 

X 

10    N/m 
2 

EI 

= 

0.0815 

Nm 

Shaft 


Figure  1.2     System  Free  Body  Diagra 
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Figure  1.2  shows  the  coordinate  system  and  the 
definition  of  terms.  For  the  development  of  the  model,  it  is 
assumed  that  the  deflection  of  the  link  is  small,  thus  the 
small  angle  theory  can  be  used.  Figure  1.3  shows  the 
deflection  of  a  section  of  the  link  and  the  radius  of 
curvat  ure. 
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Figure    1.3  Curvature    of    Bea 


rn 


From    Figure    1.3; 
dx 


also, 

Rde  =  dx 
therefore, 


1  =  ds_      dfy 

R  "  dx      ~T 
dx 


Substituting  for  -g-  into  Equation  (1)  gives 

ix-  A. 

a   2  "  EI 
dx 


or 


EI  h  =  M  . 
dx 

(£) 

In  Equation  (2),  E  and  I  are  constants  and  M  is  a 
function  of  x.  The  bending  moment  is  due  to  the  acceleration 
of  the  attached  mass  and  the  distributed  mass  of  the  link. 
The  bending  moment  due  to  the  attached  mass  at  the  end  of  the 
link  is  large  compared  to  the  bending  moment  caused  by  the 
distributed  mass  of  the  beam.  Therefore,  the  effect  of  the 
distributed  mass  on  the  fundamental  mode  of  vibration,  will 
be  negligible.  The  attached  mass  has  a  translat ional  and 
rotational  motion.  The  bending  moment  caused  by  the 
rotational  acceleration  is  small  compared  to  that  caused  by 
the  translat ional  acceleration.  The  radial  component  of  the 
inert ial  force  is  also  neglected.  fifter  developing  the 
equation  for  the  fundamental  mode  of  vibration  two  methods 
will  be  used  as  checks.  Or\e  method  will  also  be  used  to 
evaluate  the  higher  modes  of  vibration. 

From  Figure  1.2,  the  tangential  acceleration  of  the 
attached  mass  is  £S  .  The  inert ial  force  is  -m£8  .  The 
bending  moment  at  x  is: 

M  =  -nue  U  -   x)  .  (3) 

where  m  is  mass. 


Substituting    Equation     (3)     into    Equation    (2)     yields: 

d2 

EI   — ■$  =    -fTl£0    (l    -    X) 

dx 


(4) 


Integrating  from  0  to  x  yields: 


EI  $L 


/0  -mae  (i   -  x  )  dx 


x2 
-nue  (ax  -4-) 


(5) 


Since  dy/dx  =  0  at  x  =  0. 

Integrating  Equation  (5)  from  0  to  x  yields: 

2 
Ely  =  /J  -mze  (ix  -  2^)  dx 

••   v2    3 
=  -nue  U*2  -  ^) 

(6) 

since  y  =  0  at  x  =  0. 

Equation  (6)  gives  the  deflection  y  of  the  link  at  any  point 
x  along  the  link.  Of  particular  interest  is  the  deflection 
at  the  end  of  the  link.   For  x  =  it  Equation  (6)  becomes: 

yU)  =  -  Mil 
Y[    '  3EI 

(7) 

From  Figure  1.2  the  relationship  between  the   deflection 

y  (  I   )  and  the  angles  $  and  9  is: 

yU)  =  -  ZU  -  9)  (8) 


Substituting  Equation  (8)  into  Equation  (7)  gives: 


or 


mi 


3£j-  8  +  8  =  * 


(10) 

or 

"  .  3EI  .  ..  3EI 

8  +  a-  8  -  x-  $ 

mi  mi  .  (11) 

The   frequency   of  the  fundamental  mode  of  vibration   can   be 
seen  to  be: 


/  3F  T 

wn  ",/— J  =  7.03  rad/sec.  /4„v 

Y  mr  (12) 

Equation  (IS)  then  becomes: 

8  +  49.48  =  49.4*  <13) 

Taking  the  Laplace  transform  of  Equation  (13)  yields: 

S28(s)  +  49.4e(s)  =  49.4$(s).  (14) 

The  plant  transfer  function  can  be  written  as: 


>(s)  .    49.. 


S  +  49.4  .  (15) 

Equation   (15)   is   the   model  of  the  system  to   be   used   in 

developing  the  control  strategy. 

3EI 
The  constant  — ^        from  Equation   (11)   gives  the  spring 

force  K   of  the  flexible  link  by  the  relationship: 
b 


£.*. 


J  (16) 

mi 


where 

J  =  mi2     =   .0171   Kgm 
therefore: 

K.    =»  ^I  K.    =  JW2  =  0.8372   Nm 

q        1  on 

ft  spring  constant  K   is  associated  with  the  stepper  motor  and 

m 
will  be  dealt  with  in  a  later  section. 


4.   STEPPER  MOTOR  OPERATION 

A  stepper  motor  consists  of  a  magnetic  armature  and  four 

sets   of   fields  which  can  be  energized   individually   or   in 

combinations  of  two.   Figure  1.5  illustrates  the  model  of  the 

motor.    The   fields  are    oriented  so  that  as  successive  pairs 

of   fields  are  energized  the  magnetic  force  rotates   and   the 

armature   obtains  a  set  of  stable  equilibrium  positions.    If 

ari    external  torque  is  applied  to  the  armature,   the   armature 

is  displaced  from  the  equilibrium  position.   Figure  1.4  shows 

the  applied  torque,  T     ,  versus  position  relationship.   The 

app. 
maximum   torque,   T  ,   is   0.336   Nm  with  a   pair   of   fields 

h 
energized   at  rated  current.    The  3.6  degree  and  7.2.      degree 

positions   come  from  the  step  size.    If  a  torque  is   applied 

which  exceeds  the  holding  torque,   the  shaft  will  skip  to  the 

next  stable  position,  being  7. £  degrees. 

The  black,   orange,  red  and  yellow  motor  field  lines  are 

connected   to  four  transistors  which  are    switched  by  the  four 

control  lines  from  the  stepper  motor  driver  circuit   C  ,   C  , 

1    2' 


C   and  C   respectively.    When  a  control  line  has  a  logic  "1" 

3       4 
the  transistor  is  able  to  sink  current,   hence,   enabling  the 

field   to   create  a  magnetic  force.    Table  1  shows  the   full 

step   sequence   which  will  be  used  for   this   project.    When 

successive   sets   of  fields  are    energized   according   to   the 

pattern   in    Table  1,   the  magnetic  force  rotates   by   1.8 

degrees,  providing  a  torque  approximately  equal  to  T   to  move 

h 
the   armature  to  the  next  position.    The  torque  displacement 

relationship   will   be  approximated  by  a  linear   function   as 

indicated   in  Figure  1.4.   The  motor  spring  constant   is   the 

slope  of  the  torque  versus  displacement  relationship,  thus: 

K  =i=i-  =  29.0150  ^. 


TORQUE  HP PLIED  vs  DISPLACEMENT 
>~-Th    =  L3a  QZ-IN.  ; 


Figure  1.4     Torque  vs.  Angular  Displacement 
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Figure  1.5     Stepper  Motor  Model 


The  motor  spring  constant  is  much  larger  then  the  spring 
constant  due  to  the  elasticity  of  the  link.  Also,  the 
armature  inertia,  Jm,  obtained  from  the  manufacturer's 
literature,  is  much  smaller  than  the  inertia  due  to  the 
attached  mass.  The  characteristic  of  the  motor  produces  a 
fundamental  mode  of  vibration  with  a  frequency  of: 


m 


Wn  =Vi=    1099rad/sec. 


where 


Jm  =  .24  Kgcm2 
The   fundamental  mode  of  the  motor  is  large  compared  to   that 


11 

of  the  link.  Thus,  the  response  of  the  motor  may  be 
considered  to  be  instantaneous  compared  to  the  response  of 
the  1  ink. 


c1       c2       c3       c4 


1 

2 
3 


5 
6 


1 
0 


1 

0 
0 

1 


0 
0 


0 

0 

1 
1 

0 
0 


CD 


to  (J 
•J-  o 

3  p— 

<J  s_ 

O   0) 

I —  +J 

C_>  c 

3 
O 

(J 


Table  1     Full  Step  Mode  Stepping  Sequence 


MODEL  VERIFICATION 


Earlier  in  the  chapter,   a  simplified  model  of  the   link 

was   developed   and   from  the  dimensions   of   the   link,   the 

fundamental   mode  frequency  was  estimated  to  be  7.03  rad/sec. 

A   check   on  the  fundamental  mode  frequency   was   done   using 

Myklestad's   method  (see  reference  1).    The  first  mode   from 

Figure   1.6   is   approximately  7.0  radians  per   second   which 

compares   favorably  with  the  simplified   model.    Myklestad's 

method   also   provided  a  second  mode  estimate  of  134   radians 

per   second   and   a  third  mode  estimate  of   £18   radians   per 
second. 
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Figure  1.6      Fundamental  Resonant  Frequency 
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Figure  1.7      Second  Mode  Resonant  Frequency 
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Another  check  on  the  first  mode  frequency  was  made  using 
the  super  position  method.  The  later  method  uses  Dunkerley's 
general  equation  of  a  beam  with  a  continuous  load  and  a 
masslass  beam  with  a  concentrated  load  (see  Reference  £). 
The  super  position  method  also  gave  a  first  mode  frequency 
equal  to  7.8  rsd/^ec,     where: 

D  C        V  (17) 

ror  (is) 


W.  +  w' 
o        m  (19) 

where: 

W   is  the  first  mode  frequency  for  a  uniform  beam, 

b 
W    is   the   frequency   of   a  massless   beam   with   a 

m 
concentrated  load, 

W   is   Dunkerley's   approximation   for   the    combined 

T 
frequency, 

m  is  concentrated  mass  on  the  beam, 

Y  is  mass  per  unit  length  of  the  beam. 
£.   CONCLUSION 

In  this  chapter  the  flexible  link  has  been  described  and 
the  model  of  the  system  has  been  developed.  Also,  some 
characteristics  of  the  stepper  motor  have  been  presented. 
In  Chapter  II  the  control  strategy  will  be  developed  based  on 
the  model  of  the  link.  The  micro-stepper  theory  and  test 
results  will  be  discussed  in  Chapter  III. 


CHAPTER  II 

In  this  chapter  a  control  strategy  will  be  developed 
for  controlling  the  angular  displacement  of  sr\  attached  mass 
at  the  end  of  the  flexible  link.  Simulated  responses  to  step 
and  ramp  inputs  will  be  plotted  so  that  the  performance  of 
the  control  strategy  can  be  observed.  Implementation  of  the 
system,  both  hardware  and  software,  will  also  be  described. 
Test  results  for  the  implemented  control  strategy  will  be 
reported  and  evaluated  in  this  chapter  with  conclusions  and 
recommendations  given  in  Chapter  IV.  In  Chapter  III  a  micro 
stepping   concept   will  be  developed,   tested  and   evaluated. 

1.   Control  Strategy 

The  control  strategy  implemented  is  a  proportional  and 
integral  control  with  derivative  feedback  as  shown  in  the 
block  diagram  in  Figure  2.1.    From  the  general  equation: 

Output  .   G(s) 
input   '  I  +  GH(s) 

the  transfer  function  for   the  system  shown  in  Figure  £.1  is: 

Q  wj;    (KpS  +  Ki) 

r       S3  +  W^KpKdSZ  +  l?    (1    +   Kp  +   KiKd)    S  +  W2Ki 
n  n  n 

Where 

Kp  is  the  proportional  gain, 

Ki  is  the  integral  gain, 

Kd  is  the  derivative  feedback  gain  and 

W   is  the  natural  frequency  of  the  link  system. 

n 


(1) 
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and  where 

r     is  the  command  input  to  the  system  which  is  the  desired 
angular  position  of  the  mass. 

i.        SIMULATIONS 

Simulations  were  performed  using  the  Runge-Kutta  method. 
The  Runge-Kutta  method  makes  use  of  state  equations  which  can 
be  found  from  Equation  (1)  using  direct  decomposition: 


XI  =  X2  -  WJKpKdXl 


(S) 


X2    =    X3    +    WnKpr    -    Wjj    (1    +    KP    +    KiKd)Xl 


X3    =    wjjKi    (r    -    XT) 


where 


XI     i< 


(3) 


(4) 


Link  System 


1   +KdS 


Figure      2. 1 


Block    Diagram    for    a    Proportional    Plus    Integral 
Control    with      Derivative   Feedback 
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output  response:  to  r  step  input 
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Figure  2.2      Output  Response  to  a  Step  Input 


1. 


OUTPUT  RESPONSE  TO  R  RRMP  INPUT 


DE5IRED  DISPLACEMENT 


INPUT/  / 

/  / 

/  /RESPONSE 

/      / 


1/     / 


/         / 

// 


1. 


2. 


4.       Time 


>  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i  i i  ,  ,  i  ,  | 


i  i  i 


Figure   2.3  Output    Response    to   a    Ramp    Input 
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The  simulated  responses  to  a  step  and  a  ramp  input  ara 
shown  respectively  in  Figures  2. 2  and  £.3  with  Kp  =  1  ,  Ki  = 
50  and  Kd  =  .£5.  A  ramp  input  will  be  used  in  the  actual 
implementation  to  allow  for  the  inertia  ar.d  flexibility  of 
the  system.  The  slope  of  the  ramp  is  determined  by  R  where 
input  r  equals  Rt. 

3.   IMPLEMENTATION 

The  feedback  signal  comes  from  a  pair  of  strain  gauges 
placed  on  either  side  of  the  flexible  link,  close  to  the 
base.  Error  in  the  signal  for  strain  gauges,  due  to 
temperature  changes,  are  canceled  out  when  a  pair  of  strain 
gauges  are  used.  A  Wheat stone  bridge  is  used  in  connection 
with  a  DAYTRONIC  (model  £000)  strain  gauge  conditioner  (see 
Reference  3)  as  shown  in  Figure  £.4.  The  5V  DC  to  £Hz 
analog  signal  is  used.  An  ANALOG  DEVICES  (model  ADC10Z) 
Analog  to  Digital  Converter  is  used  to  digitize  the  strain 
gauge  signal  (see  Reference  4).  The  A/D  converts  the  analog 
signal  to  a  £' s  compliment  digital  value.  The  digital  value 
from  the  A/D  is  read  by  the  MOTOROLA  68000  microprocessor  on 
a  MOTOROLA  (model  MC68000)  single  board  computer  (see 
Reference  5)  . 

The  control  strategy  is  implemented  in  the  MC68000 
microcomputer  while  the  control  of  the  stepper  motor  is 
implemented  in  a  MOTOROLA  (model  MEK680£D5)  microcomputer 
which  uses  a  680£  microprocessor  (see  Reference  6).  Digital 
values  are    passed  from  the  MC6800IZI  microcomputer  to  the 
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MEK6802D5  microcomputer  by  an  8  bit  latch  so  the  MEK6802D5 
microcomputer  can  read  at  any  time.  Also,  the  MEK68GJ2D5 
microcomputer  can  write  to  the  latch  at  any  time.  Thus, 
the  two  microcomputers  need  not  be  synchronized.  The  stepper 
motor  control  will  be  discussed  in  the  next  chapter  along 
with  the  micro-stepper  theory  of  operation. 
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Figure  2.4      Wheatstone  Bridge  and  Strain  Gauge  Conditioner 
The   input   to  the  system,  r   ,   is   calculated   by   the 
MC68000  microcomputer.   From  Figure  £.  1,  <j>   is: 


(5) 


«  (Kp  +  -^-)(r  -  (1  +  KdS)  e)  (5) 
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or 


*  -  (Kp  *  fy(r    -  (1  +  KdS)"^  (6) 


where: 

9  =  JL 

9    Kv  .  (7) 

Substituting  Equation  (7)  into  Equation  (6)  yields: 

*  =  (KP  +  —  )E 

S  (8) 


where: 


t  -   [r   -  (  — ^  +  — )  Kv; 


S' 

By  inspection  of  Equation  (8)  the  first  two  integrals  of 
V  Are  needed.  The  first  two  integrals  of  V  can  be  computed 
by: 

Vintl  =  Vintl  +  V(I)T 

Vint2  ■  Vint2  +  VintlT 
where 

Vintl  is  the  first  integral  of  V, 

Vint2  is  the  second  integral  of  V, 

V<I)  is  the  present  feedback  and 

T  is  the  sampling  period. 
The  integral  of  E  is  also  needed.    It  can  be  obtained  in  the 
same  manner  as  Vintl. 

4.   TESTING  AND  RESULTS 

The  tests  were  done  by  implementing  the  control  strategy 
in  the  MOTOROLA,   1*10680130  microcomputer  and  the  micro-stepper 
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maintenance  program,  to  be  discussed  in  Chapter  3,  in  the 
MOTOROLA  MEK6802D5  microcomputer.  The  micro-stepper  circuit 
interfaces  between  the  MEK680£D5  microcomputer  and  the 
stepper  motor  is  shown  in  Appendix  A. 

The  control  strategy  implemented  worked  as  expected. 
The  mass  at  the  end  of  the  link  started  with  a  small  velocity 
then  increased  in  the  middle  and  decreased  to  zero  at  the  end 
of  the  move.  There  ^re  limits  imposed  on  the  control 
strategy  by  some  assumptions  made  in  Chapter  1.  The  limits 
will  be  discussed  in  Chapter  A,  Conclusions  and 
Recommendations.  If  the  operation  of  the  system  is  not  held 
within  the  limits,  the  control  breaks  down. 


CHAPTER  III 

1.   INTRODUCTION 

In  this  chapter  a  problem  encountered  with  the  system 
using  conventional  stepper  motor  control  will  be  presented, 
followed  by  a  discussion  of  the  concept  of  micro-stepping, 
ftlso,  the  reason  that  micro- stepping  eliminates  the  problem 
will  be  discussed.  ft  scheme  to  accomplish  micro-stepping 
will  be  presented.  The  implementation  and  evaluation  of  the 
micro-stepping  operation  will  be  presented. 

The  maximum  stepping  rate  accepted  by  the  stepper  motor 
used  in  this  project  is  600  steps  per  second  in  the  full  step 
mode.  The  link  with  the  attached  mass  is  a  lightly  damped 
resonant  system  with  first,  second  and  third  mode  frequencies 
of  1.11,  30.87  and  98.36  Hz,  respectively.  If  a  stepping 
rate  risar  the  resonant  frequencies  is  commanded,  the  resonant 
mode  will  be  excited  and  the  link  will  experience  significant 
oscillations.  The  first  three  resonant  frequencies  lie 
within  the  range  of  the  stepping  rates  being  sent  to  the 
stepper  motor.  When  the  stepper  motor  operates  around  the 
resonant  frequencies,  the  respective  modes  of  vibration  are 
excited,  making  the  response  unacceptable. 

One  potential  solution  to  the  problem  is  to  keep  the 
stepping  rates  away  from  the  resonant  frequencies.  This 
solution  cannot  be  used  and  still  obtain  satisfactory 
operation.  Another  potential  solution  is  to  add  damping 
to  the  system.    This  is  rather  difficult  to  do  and  would  add 
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6. 
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9. 


Table 


Full  Step  vs.  Half  Step  Stepping  Sequence 


mass  to  the  system  which  would  defeat  the  purpose  of  having  a 
low  mass  link.  ftn  alternative  would  be  to  stiffen  the  link, 
thus  raising  the  resonant  frequencies  of  vibration.  Raising 
the  fundamental  frequency  from  1.11  Hz  to  a  value  suitable 
for  stepping  rates  up  to  600  Hz  would  require  increasing  the 
stiffness  by  about  250,000  times  since  the  resonant  frequency 
is  proportional  to  the  square  root  of  the  stiffness.  This 
would  also  add  mass  to  the  system. 

The  method  selected  was  to  increase  the  stepping  rate 
and  reduce  the  step  size.  This  technique  is  called  micro 
stepping.  If  50  microsteps  are  placed  between  each  full 
step,    the   stepping   rate   for   any   prescribed   motion   is 
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increased  by  a  factor  of  50.   Also  the  amplitude  of  the  steps 
would  be  decreased  by  a  factor  of  50. 

With  50  rnicrosteps  per  full  step,  the  stepping  rate 
ranges  from  0  to  30  KHz,  and  the  amplitude  is  .036  degrees. 
Although  it  is  still  theoretically  possible  to  excite  the 
resonant  modes,  the  excitation  amplitude  is  now  so  small  and 
the  prescribed  motion  so  slow  that,  in  fact,  the  small  amount 
of  damping  that  exists  in  the  system  eliminates  the  resonance 
problem. 

2.   THEORY  OF  MICRO- STEPPING 

Micro  -  stepping  works  on  the  same  principle  as  the  full 
step  mode.  In  the  full  step  mode  two  fields  in  the  motor  Are 
energized.  This  produces  two  forces  on  the  armature.  The 
armature  assumes  a  position  between  the  two  fields.  The 
placement  of  the  armature  depends  upon  which  field  exerts  the 
strongest  force.  The  force  is  proportional  to  the  current 
through  the  field.  Assuming  all  of  the  fields  have  the  same 
characteristics,  the  position  can  be  directly  related  to  the 
currents  through  the  fields.  If  the  two  fields  have  the  same 
current,  as  is  the  case  with  the  full  step  mode,  the  armature 
would  be  exactly  in  the  middle.  If  one  field  has  a  higher 
current  than  the  other  field,  it  would  produce  a  greater 
force  on  the  armature.  The  armature  would  then  be  closer  to 
the  field  with  more  current  passing  through  it.  Assuming  the 
amount  of  current  through  each  field  can  be  controlled,  then 
micro-stepping  can  be  done.  By  dividing  the  current  into  50 
units,   100  rnicrosteps  can  be  placed  between  each  step.   This 
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is  achieved  by  letting  0  units  of  current  through  field  1  and 
50   through  field  2.  Then  increase  the  units  of  current   in 

field  1  and  decrease  the  units  of  current  in  field  £  in  a 
staggered  sequence.  This  is  done  in  increments  of  one. 
Table  3  illustrates  the  staggered  sequence. 

By  not  using  the  even  numbered  rnicrosteps  in  Table  3,  50 
microsteps  can  be  placed  between  each  full  step.  As 
previously  stated,  only  50  rnicrosteps  per  full  step  will  be 
used.  The  decision  to  use  50  instead  of  100  microsteps  was 
made  based  on  maximum  speed.  The  maximum  speed  that  car\  be 
achieved  using  100  microsteps  with  a  1  MHz  clock  is  1/2 
revolution  per  second.  A  higher  rotational  velocity  is 
desired  for  this  project. 


mstep 


1 
2 
3 
4 
5 
6 


Units  of  Current 
in  Phase  One 


0 
1 
1 
2 
2 
3 


Units  of  Current 
in  Phase  Two 


50 
50 
49 
49 
48 
48 


Table  3      100  Microsteps  per  Full  Step 
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Fi  gure  3.  1 


Timing  Diagram 

C(0)  is  loaded  with  5, 

C(l)  is  loaded  with  1  and 

C(£>  is  loaded  with  4 


3.   DEVELOPMENT  OF  MICRO  STEPPING 

Pulse  width  modulation  is  used  to  divide  the  maximum 
current  through  the  fields  into  50  units  of  current.  The 
decision  to  use  pulse  width  modulation  was  based  on  the 
assumption  that  the  stepper  motor  filters  pulses  coming  from 
counters,  therefore  averaging  the  current  into  the  stepper 
motor.  Three  sixteen  bit  counters  C(0),  0(1)  and  C(£)  are 
used  to  achieve  the  pulse  width  modulation.  The  three 
counters  all  are  in  a  single  integrated  circuit,  a  NATIONAL 
SEMICONDUCTOR  INS8253N  (see  Reference  7).  This  integrated 
circuit,  IC,  is  referred  to  as  a  programmable,  timer-counter. 
Each  of  the  three  counters  can  be  programmed  to  operate  in 
several  different  modes.  Only  the  mode  and  features  of  the 
counter  used  in  this  project  will  be  described. 

Each  of  the  counters  is  associated  with  three  pins  on 
the  IC.  One  pin  is  the  clock  input  pin,  one  is  the  gate 
input  and  the  other  is  the  output.  Each  counter  has  a  buffer 
register   into   which  a  count  value  can    be   loaded   from   the 
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MEK680£'D5  microcomputer.  In  the  operating  mode  used  for  this 
project,  when  the  gate  input  signal  goes  from  low  to  high, 
the  value  in  the  buffer  register  is  loaded  into  the  counter, 
the  clock  input  is  enabled,  and  the  output  is  driven  low  (one 
half  clock  cycle  later).  Each  pulse  on  the  clock  input 
causes  the  counter  to  count  down  one.  While  the  counter  is 
counting  down,  the  output  remains  low.  When  a  count  value  of 
zero  is  reached,  the  output  goes  high  and  the  clock  input  is 
disabled  until  the  gate  input  has  another  low  to  high 
transit  ion. 

One  counter,  C(0),  provides  the  basic  cycle  timing.  ft 
clock  signal  at  895  KHz  is  connected  to  its  clock  input  pin. 
ft  value  of  50  is  loaded  into  its  buffer  register  and  its 
output  is  connected  to  its  gate  so  that  it  reinitializes 
itself  when  it  counts  out.  This  counter  provides  the 
initialization  signal  (its  output)  which  is  used  to  gate  the 
other  two  counters.  The  895  KHz  clock  signal  is  connected  to 
the  clock  inputs  of  all  three  counters.  Values  between  1  and 
49  are  loaded  into  the  buffer  registers  of  counters  C(l)  and 
C<2).  The  outputs  of  counters  C(l)  and  C(2)  will  be  pulses 
which  are  low  for  the  number  of  clock  cycles  equal  to  the 
value  loaded  into  their  buffer  registers.  The  outputs  of 
counters  C(l)  and  C(£)  then  return  high  for  the  balance  of 
the  basic  timing  cycle.  Counters  loaded  with  0  count  out  the 
maximum  counts  of  65,536  (see  Reference  7  mode  1). 
Therefore,  the  values  of  50  and  0  are  not  used. 
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By   increasing  and  decreasing  the  respective  counters  by 

increments  of  1  from  1  to  49  and  49  to  1,   49  rnicrosteps  cari 

be  taken  in  50  gates.    Each  microstep  will  have  a  spacing  of 

1   full  step  divided  by  50.    The  basic  configuration  of   the 

counters  can  be  seen  in  Figure  3.2. 

To   ensure  a  smooth  transition  from  one  full  step  to   the 

next,   caution   must   be  taken  to  make  sure   counter  C(l)   is 

PNDed   with   control  lines  C   and  C   and  C(£)  is   ANDed   with 

1      a 
control   lines  C   and  C  .    A  MOTOROLA  SAA1042  stepper   motor 

3       4 
driver  determines  which  control  lines  are    on  (see  Table  1  and 

Reference  8).   After  setting  the  bias  on  the  MOTOROLA  SAA104S 

stepper  motor  driver,   C   and  C  are    on.    Therefore,  C   must 

1       3  1 

go   from  full  on  to  full  off  and  C   from  full  off  to  full   on 

3 
for  clockwise  operation.    To  do  this,   C<1)  should  be  loaded 

with   1   and  incremented  to  49  and  C(£)  loaded   with   49  and 

decremented  to  1.   The   SAA1042  stepper  motor  driver  car\  then 

be  clocked  to  the  next  step.   After  the  stepper  motor 

driver  has  been  clocked,  C(l)  should  then  be  decremented  to  1 

and  C(£)  incremented  to  49.    A  continuation  of  this   process 

will   ensure   a  smooth  transition  from  one  full  step   to  the 

next. 
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Basic  Micro-Stepper  Circuit 


Loading  5  in  counter  C(<d)  and  following  the  procedure 
described  above  will  result  in  a  micro-stepping  sequence 
shown  in  Figure  3.3.  The  rnicrostep  spacing  for  microsteps  1, 
£  and  3  are  1/5  of  a  full  step  and  rnicrostep  4  is  £/5  of  a 
full  step.  Again,  this  is  due  to  the  inability  to  load  Z  in 
the  counters.  fin  alternative  would  be  to  take  1  rnicrostep  at 
rnicrostep  5.  To  do  this,  microsteps  1  and  4  need  to  be  l/£ 
of  a  rnicrostep  and  microsteps  £  and  3  need  to  be  1  rnicrostep. 
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Figure  3.4      Micro-Stepping  Sequence  Method  1 
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Pi  half  of  a  step  is  accomplished  by  staggering  steps  as 
shown  in  Table  3.  This  method  results  in  the  stepping 
sequence  shown  in  Figure  3.4.  The  second  method  will  not  be 
used  due  to  art  increase  of  required  logic.  Only  one 
rnicrostep  can  be  taken  per  basic  timing  cycle,  which  is 
determined  by  the  value  loaded  into  counter  C<0).  If  more 
than  orie  rnicrostep  is  taken  within  50  clock  cycles  of  the 
basic  cycle  time,  the  first  rnicrostep  loaded  into  the 
buffer  registers  of  counters  C(l)  and  C<2)  will  be  skipped. 
Therefore,   caution   must   be   taken  with   the   micro-stepper 

maintenance  program  that  is  implemented  in  the  MEK6802D5 
microcomputer,  so  that  no  more  than  one  rnicrostep  is  taken 
per  50  clock  cycles  of  the  MEK6802D5  microcomputer.  Figure 
3.5  is  a  flow  chart  of  the  micro-stepper  maintenance  program 
implemented  in  the  MEK6802D5  microcomputer. 

4.   TESTING  AND  RESULTS 

Testing  of  the  micro-stepper  circuit  was  achieved  by 
placing  a  mirror  on  the  flat  surface  of  the  motors  shaft  and 
directing  a  laser  at  the  center  of  the  mirror.  Using  this 
layout  enabled  the  rotation  of  the  shaft  to  be  measured  on  a 
wall  £1  feet  away  (see  Figure  3.6a  and  b)  . 

By  having  two  fields  on  half  the  time,  .9  degrees  can  be 
taken  in  either  direction  in  .036  degree  increments.  The 
distance  that  the  laser  beam  traveled  on  the  wall  was 
measured  to  the  nearest  1/32  of  sr,  inch.  Knowing  the 
distance    from   the   wall   to   the    mirror,    the    angular 
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Figure  3.6b      Top  View  of  Test  Set  Up 
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displacement   could   then  be  found.    Using  the   small   angle 
theory,  the  angular  displacement  is: 

d 
♦  -   27  (l) 

where:      d  is  displacement  on  the  wall  in  inches, 

r   is  distance  from  the  mirror  to  the  wall  and   is 
252  inches. 

The   angular   displacement  of  the  shaft  is  also  the  angle   of 

incidence  at  which  the  laser  strikes  the  mirror.    The  number 

2,  in  the  denominator  comes  from: 


0  =  2<fr  (2) 

where:      6  is  the  angle  between  the  reflection  of  the  laser 
beam  and  the  laser  beam  itself  (see  Figure  3.6b). 

Eight   tests  were  done,   using  50  microstep   spacing   on 

randomly   selected  full  steps.    The  eight  samples  were  found 

by  rotating  the  base  of  the  stepper  motor.    The  tests  showed 

that   the  angular  displacement  per  microstep  was  not   uniform 

(see  Figure  3.7).   Each  microstep  should  be  .036  degrees   for 

the   spacing   to   be  linear.    Figure  3.7  shows   the   average 

displacement   for  each  separate  microstep  of  the  eight   tests 

done.   The  mean  deviation  from  data  in  Figure  3.7  is  small  in 

comparison,   being   0  to  10  percent,   of  the  average   angular 

displacement  of  each  microstep  (see  ftppendix  B) .    The  larger 

deviations   were  taken  from  the  ends  of  the  graph   where   the 

deviation    percentage   is   more   sensitive   to   the    error. 

Therefore,   Figure  3.7  accurately  depicts  the  displacement  of 

each  microstep  for  any  set  of  microsteps. 


34 

A  conclusion  to  be  made  from  Figure  3.7  is  that  the 
current  through  the  fields  do  not  correspond  linearly  to  the 
change  in  on  and  off  time  of  the  counters.  This  conclusion 
was  checked  by  reading  the  current  meter  that  is  on  the 
LAMBDA  done  voltage  source  used.  The  maximum  current  that 
passes  through  one  field  when  it  is  on  and  the  other  field  is 
off  is  approximately  1  amp.  Data  was  obtained  by  changing 
data  in  the  counters  by  increments  of  5  and  measuring  the 
change  in  current  through  a  field.  By  inspecting  Figures  3.7 
and  3.8  it  is  seen  that  they  are  roughly  similar.    The  graph 

shows   that  the  conclusion  made  was  correct     (see  Figures   3.7 
and  3. 8) . 
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Figure  3.8     Change  in  Current  vs.  Microstep 

Also,  the  distance  of  each  full  step  is  not  consistent. 
The  average  full  step  size,  recorded  on  the  wall,  is  508. 9/3£ 
inches  (see  Appendix  B) .  The  maximum  deviation  from  the 
average  is  17. 9/3S  of  an  inch.  The  average  deviation  is 
7.6/32  of  an  inch  (see  Appendix  B) .  This  shows  that  there  is 
inherent  error  in  the  spacing  of  the  motor's  fields.  The 
maximum  error  per  microstep  is  found  from: 

e   =  10-4  -  3   7.4 

1  32      TT  inches 

e  =  -3575 

2  32  inches 


!T  \  •?  *  4 
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eT  =  .225  inches  =  .025  degrees 
where: 

e   is  the  maximum  deviation  from  all  average  microsteps 

1 
e    is   the   maximum  deviation  from  the  average   of   the 

2 
eight  sets  and 

e   is  the  maximum  error 
T 
where   each   microstep   should  be  .036   degrees   for   uniform 

microstepping.  The  error,  in  percentage  form  is: 

eT 

e  'row   10°  s  7"".i*  • 

5.   CONCLUSION 

The  reason  the  micro-stepper  was  developed  has  been 
discussed.  Also,  the  theory  and  implementation  have  been 
presented.  The  micro-stepper  worked  well  except  for  the 
nonlinearity  of  displacement  verses  microstep. 

The  nonlinearity  of  the  change  of  current  versus 
microstep  could  possibly  be  due  to  electrical  characteristics 
of  the  micro-stepper  circuit,  stepper  motor,  or  even  the 
power  supply.  Finding  the  source  of  the  nonlinearity  is 
beyond  the  scope  of  this  project  and  will  not  be  dealt  with. 


CHAPTER  IV 

1.   CONCLUSIONS 

The  control  strategy  worked  well. 
Anticipated  limits  of  the  system  were  observed.  One  limit  is 
imposed  or\  the  control  strategy  by  the  use  of  the  small  angle 
theory.  This  puts  a  limit  on  the  acceleration  and  the  slope 
of  the  ramp  of  the  input  to  the  system.  Another  limit  on  the 
acceleration  of  the  micro-stepper  is  the  holding  torque  of 
the  micro-stepper.  The  dominating  limit  is  the  limit  imposed 
on  the  system  by  the  use  of  the  small  angle  theory.  When 
operating  over  the  limit  due  to  the  small  angle  theory,  the 
model  of  the  system  used  in  the  control  strategy  does  not 
accurately  describe  the  characteristics  of  the  system.  This 
can  be  seen  physically. 

The  rnicrostep  spacing  of  the  micro -stepper  was  not 
linear  as  pointed  out  in  Chapter  3.  This  is  due  to  the 
current  being  nonlinear  through  each  set  of  rnicrosteps.  The 
source  of  nonlinearity  of  the  change  in  current  versus 
rnicrostep  will  not  be  dealt  with,  it  being  beyond  the  scope 
of  this  project. 

£.   RECOMMENDATIONS 

To   correct   the   error  in  angular   displacement   versus 
rnicrostep,   a   current  feedback  system  could  be   implemented. 
The  current  feedback  should  force  the  angular  displacement  to 
be  linear.    Also,  a  stronger  stepper  motor  should  be  used  so 
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larger  angular  accelerations  could  be  obtained.  To  obtain 
larger  speeds,  a  microcomputer  with  a  faster  system  should  be 
used. 

To   obtain   more   versatility   of   movement,   a   control 
strategy   that  uses  spline  functions  as  inputs  could  be  used. 
The   system   could   also  be  expanded  into   a   two   degree   of 
freedom  link.   Combinations  of  rigid  links  could  be  used. 
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HARDWARE  DESCRIPTION 


When  writting  to  the  8253  Programmable  Counter/Timer  from 
the  MEK6802D5  microcomputer,  the  data  becomes  invalid  before  the  Read/Write 

signal  does.  To  correct  for  this,  a  74LS121  Monostable  Multivibrator 
was  used  to  shorten  the  time  that  the  write  cycle  is  high.  The  MEK6802D5 
microcomputer  does  not  read  from  the  8253  Programmable  Counter/Timer.  Also, 
when  the  MC68000  microcomputer  writes  to  the  latch  which  contains  the 
control  command  to  the  system,  or  when  it  reads  the  feedback  signal  from 


the  A/D,  the  Read/WHta  signal  stays  valid  longer  than  the  data.  This 
problem  is  also  solved  by  using  a  74LS121  Monostable  Multivibrator. 

The  ADC10Z  A/D  is  permanently  shifted  up,  depending  on  the 
magnitude  of  the  input,  in  the  bipolar  mode.  An  external  bias  was  added 
to  the  A/D  to  compensate  for  this.  The  external  bias  is  illustrated  below. 


ADCIOZ  ,s 


vWV-i 
2ook 


2SK 


+  5V 


2.5  K 


External  bias  circuit  for  A/D  Converter. 
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The  control  lines  that  come  from  the  74LS08  AND  gates  were 

used  to  pulse  4  transistors  (SK3180's)  to  allow  current  to  pass  through 

to  ground.  When  a  transistor  is  in  the  on  state  the  respective  electrical 

field  is  enegized  in  the  stepper  motor.  To  protect  the  transistors  from 

possible  voltage  spikes  caused  by  the  electrical  field  collapsing,  diode 

were  placed  between  the  collector  of  the  transistor  and  the  supply 

voltage  to  the  motor.  This  can  be  seen  in  the  figure  below. 


Ci 


C, 


1 


\ 


\ 


\ 


+  ISV 


Diode  protection  of  the  switching  transistors. 
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To  obtain  a  better  time  response  from  the  stepper  motor 
external  power  resistors  were  placed  in  series  with  the  power  supply 
and  the  stepper  motor.  The  voltage  is  then  raised  to  get  a  better 
response  time  from  the  stepper  motor.  The  calculations  are  as 
follows: 


T=-L 


K* 


Re+Ri 

1 


Re+Ri 
and 

where  V  is  increased  so  that  KV  is  constant. 


MOTOROLA  D5  KIT  CABLES 
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MEK6802D5  Microcomputer 
BUS  CONNECTOR 


J15 

J14 

DIP  PIN  NO. 

SIGNAL  NAME 

EDGE  CONNECTOR 

1 

NC 

2 

(HALT)' 

4 

3 

MR 

R 

4 

(IRQ)' 

D 

5 

VMA 

F 

6 

( NM I ) ' 

E 

7 

BA 

P 

8 

VCC(+5V) 

1,A 

9 

AO 

40 

10 

Al 

V 

11 

A2 

0" 

12 

A3 

39 

13 

A4 

38 

14 

A5 

r 

15 

A6 

S' 

16 

A7 

37 

17 

A8 

36 

18 

A9 

R1 

19 

A10 

P' 

20 

All 

35 

21 

NC 

22 

A12 

34 

23 

A13 

N' 

24 

A14 

M' 

25 

A15 

33 

26 

D7 

J' 

27 

D6 

L' 

28 

D5 

30 

29 

D4 

32 

30 

D3 

H' 

31 

D2 

K' 

32 

Dl 

29 

33 

DO 

31 

34 

R/W 

6 

35 

-12V 

11,  M 

36 

+12V 

16, T 

37 

E(02) 

J 

38 

-5V 

25 

39 

GND 

43,  V 

40 

(RESET) 

5 

MC68000  Wire  Wrap  Region 
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■yS£R  otack 


MC68000  Board  Layout  for  Bus  Expansion 


46 


Row    1 


2   3 


U2 


Hole 

1 

2 

3 

4 

5 

6 

7 

8 

9 

10 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 


U1-74LS245  - 
U2-74LS244  - 
U3-74LS244  - 
U4-74LS244  - 

U5-74LS07  - 

U6-75LS11  - 

U7-74LS04  - 


Octal  Bus  Transceiver  -  Data  Bus  Buffer  D0-D7   (20  pins) 

Octal  Bus  Buffer  -  Address  Bus  Buffer  A1-A8   (20  pins) 

Octal  Bus  Buffer  -  Address  Bus  Buffer  A9-A15  &  AS   (20  pins) 

Octal  Bus  Buffer  -  Control  Line  Buffer  LDS,  R/W  FC2  FC1 

FCO,  VMA,  El,  E2   (20  pins)' 

Hex  Buffer  -  Nontristate  Control  Lines  E,  8MHz  Clk  4MHz 
Clk,  1MHz  Clk,  E3,  E6   (14  pins) 

Triple  Three  and  Gates  -  Buffer  Enable  Logic  El  E2  E3  E4 

E5,  E6   (14  pins)  '   ' 

Hex  Inverters  -  Buffer  Enable  Logic  E6   (14  pins) 


NATIONAL  SEMICONDUCTOR  8253  (U8) 
Programmable  Counter/Timer 
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Pin  Number 

Designation 

Connection  Description 

1 

Data  Bit  7 

Dip  Pin  No.  26  from 
MEK6802D5  Microcomputer  (J15) 

2 

Data  Bit  6 

Dip  Pin  No.  27  from 
MEK6802D5  Microcomputer  (J15) 

3 

Data  Bit  5 

Dip  Pin  No.  28  from 
MEK6802D5  Microcomputer  (J15) 

4 

Data  Bit  4 

Dip  Pin  No.  29  from 
MEK6802D5  Microcomputer  (J15) 

5 

Data  Bit  3 

Dip  Pin  No.  30  from 
MEK6802D5  Microcomputer  (J15) 

6 

Data  Bit  2 

Dip  Pin  No.  31  from 
MEK6802D5  Microcomputer  (J15) 

7 

Data  Bit  1 

Dip  Pin  No.  32  from 
MEK6802D5  Microcomputer  (J15) 

8 

Data  Bit  0 

Dip  Pin  No.  33  from 
MEK6802D5  Microcomputer  (J15) 

9 

Clock  for 
Counter  0 

Dip  Pin  No.  38  from 
MEK6802D5  Microcomputer  (J15) 

10 

Output  for 
Counter  0 

Jumper  to  Pin  11  of 

8253  Programmable  Counter/Timer  (U8) 

11 

Gate  for 
Counter  0 

Jumper  to  Pin  10,  14,  16  of 

8253  Programmable  Counter/Timer  (U8) 

12 

Ground 

Ground 

13 

Output  for 
Counter  1 

Pins  12  &  9  on  Ul 3 

in  Micro  -  Stepper  Circuit 

14 

Gate  for 
Counter  1 

Jumper  to  Pin  11  of 

8253  Programmable  Counter/Timer  (U8) 

15 

Clock  for 
Counter  1 

Dip  Pin  No.  38  from 
MEK6802D5  Microcomputer  (J15) 

16 

Gate  for 
Counter  2 

Jumper  to  Pin  11  of 

8253  Programmable  Counter/Timer  (U8) 

17 

Output  for 
Counter  2 

Pins  1  &  b  on  U13 

in  Micro  -  Stepper  Circuit 

18 

Clock  for 
Counter  2 

Dip  Pin  No.  38  from 
MEK6802D5  Microcomputer  (J15) 

19 

AO,  Register 
Select 

Dip  Pin  No.  9  from 
MEK6802D5  Microcomputer  (J15) 

20 

Al ,  Register 
Select 

Dip  Pin  No.  10  from 
MEK6802D5  Microcomputer  (J15) 

21 

Chip  Select 

Pin  15  on  U12 

in  Micro  -  Stepper  Circuit 

22 

IOR,  Read 
Control 

NC 

23 

IOW,  Write 
Control 

Pin  1  on  U14 

in  Micro  -  Stepper  Circuit 

24 

Vcc 

+5V 

MOTOROLA  SAA1042  (U9) 
Stepper  Motor  Driver 
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Pin  Number 

Designation 

Connection  Description 

1 

Control  Line  2 

Pin  10  on  U13 

in  Micro  -  Stepper  Circuit 

2 

VD 

+5V 

3 

Control  Line  1 

Pin  13  on  U13 

in  Micro  -  Stepper  Circuit 

6 

Set/Driver  Bias 

Pin  10  on  U12 

in  Micro  -  Stepper  Circuit 

7 

Clock 

Pin  8  on  Ull  in  Micro  -  Stepper  Circuit 
with  a  30Kohm  Pull  Down  Resistor 

8 

Full  Step/ 
Half  Step 

Ground  for  Full  Step  Mode 

9 

Ground 

Ground 

10 

Clock  Wise/ 
Counter  Clock  Wise 

Pin  11  on  Ull 

in  Micro  -  Stepper  Circuit 

11 

Vcc 

+5V 

14 

Control  Line  4 

Pin  4  on  U13 

in  Micro  -  Stepper  Circuit 

15 

VM 

+5V 

16 

Control  Line  3 

Pin  2  on  U13 

in  Micro  -  Stepper  Circuit 

74LS00  Quad.  2  -  Input  (U10) 
Positive  -  NAND  Gates 
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Pin  Number 

Designation 

Connection  Description 

1 

InDut  1A 

Dip  Pin  9  on  J15  and  Jumpered  to  Ground 
with  a  750  Picofarad  Cap.  &  IKohm  Res. 

2 

Input  IB 

Dip  Pin  14  on  J15  and  Jumpered'to 
Ground  with  a  IKohm  Resistor 

3 

Output  1Y 

Pin  1  on  U20 

4 

Input  2A 

NC 

5 

Input  2R 

NC 

6 

Output  2Y 

NC 

7 

Ground 

Ground 

8 

Output  3Y 

Pin  1  on  U19 

9 

Input  3A 

Dip  Pin  13  on  J16  with  a  lOKohm 
Pull  Down  Resistor 

10 

Input  3B 

Jumper  to  Pin  13  on  U10 

11 

Output  4Y 

Pin  1  on  U18 

12 

Input  4A 

Dip  Pin  11  on  J16  with  a  loKohm 
Pull  Down  Resistor 

13 

Input  4B 

Pin  6  on  U17 

14 

Vcc 

+5V 

74LS00  Quad.  2  -  Input  (Ull) 
Positive  -  NAND  Gates 


50 


Pin  Number 

Designation 

Connection  Description 

1 

Input  1A 

Pin  14  on  U12 

2 

Input  IB 

Jumper  to  Pin  11  on  Ull 

3 

Output  1Y 

Jumper  to  Pin  12  on  Ull 

4 

Input  2A 

Pin  12  on  U12  with  a  360  Picofarad 
Capacitor  to  Ground 

5 

Input  2B 

Jumper  to  Pin  8  on  Ull 

6 

Output  2Y 

Jumper  to  Pin  9  on  Ull 

7 

Ground 

Ground 

8 

Output  3Y 

Jumper  to  Pin  5  on  Ull  and 
Pin  7  on  U9 

9 

Input  3A 

Jumper  to  Pin  6  on  Ull 

10 

Input  3B 

Pin  11  on  U12 

11 

Output  4Y 

Jumper  to  Pin  2  on  Ull  and 
Pin  10  on  U9 

12 

Input  4A 

Jumper  to  Pin  3  on  Ull 

13 

Input  4B 

Pin  13  on  U12 

14 

Vcc 

+5V 

TEXAS  INSTRUMENT  74LS138  (U12 ) 
3  Line  Decoder/Demultiplexer 
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Pin 

Number 

Designation 

Connection  Description 

1 

Select  Line  A 

Dip  Pin  24  from 

MEK6802D5  Microcomputer  (J15) 

2 

Select  Line  B 

Dip  Pin  23  from 

MEK6802D5  Microcomputer  (Jl 5) 

3 

Select  Line  C 

Dip  Pin  22  from 

MEK6802D5  Microcomputer (Jl 5) 

4 

Enable  Line  G2A 

Ground 

5 

Enable  Line  G2b 

Ground 

6 

Enable  Line  Gl 

Pin  8  on  U15 

in  Micro  -  Stepper  Circuit 

7 

Output  Y7 

NC 

8 

Ground 

Ground 

9 

Output  Y6 

NC 

10 

Output  Y5 

Pin  6  on  U9 

in  Micro  -  Stepper  Circuit 

11 

Output  Y4 

Pin  10  on  Ul  1 

in  Micro  -  Stepper  Circuit 

12 

Output  Y3 

Pin  4  on  Ull 

in  Micro  -  Stepper  Circuit 

13 

Output  Y2 

Pin  13  on  Ull 

in  Micro  -  Stepper  Circuit 

14 

Output  Yl 

Pin  1  on  Ull 

in  Micro  -  Stepper  Circuit 

15 

Output  YO 

Pin  21,  on  1/8 

in  Micro  -  Stepper  Circuit 

16 

Vcc 

+5V 

74LS08  Quad.  2  -  Input  (U13) 
Positive  -  AND  Gates 
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Pin  Number 

Designation 

Connection  Description 

1 

Input  1A 

Pin  17  on  U8 

2 

Input  IB 

Pin  16  on  U9 

3 

Output  1Y 

This  is  Control  Line  3  to  switch  the 
Stepper  Motor(^3) 

4 

Input  2A 

Pin  14  on  119 

5 

Input  2B 

Jumpered  to  Pin  1  on  U13 

6 

Output  2Y 

This  is  Control  Line  4  to  Switch  the 
Stepper  Motor^) 

7 

Ground 

Ground 

8 

Output  3Y 

This  is  control  Line  2  to  Switch  the 
Stepper  Motor(^) 

9 

Input  3A 

Jumpered  to  Pin  12  on  U13 

10 

Input  3B 

Pin  1  on  U9 

11 

Output  4Y 

This  is  Control  Line  1  to  Switch  the 
Stepper  Motor(C-j ) 

12 

Input  4A 

Pin  13  on  U.8 

13 

Input  4B 

Pin  3  on  U9 

14 

Vcc 

+5V 

74LS121  Monostable  Multivibrator  (U14) 
with  Schmitt  -  Trigger  Inputs 
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Pin  Number 

Designation 

Connection  Description 

1 

Q  Output 

Pin  11  on  1)8 

in  Micro  -  Stepper  Circuit 

2 

NC 

NC 

3 

Al  Input 

Dip  Pin  No.  34  from 

J15  with  a  Pull  Up  IKohm  Resistor 

4 

A2  Input 

Jumper  to  Pin  5  on  Ul 4 
Which  is  Connected  to  +5V 

5 

B  Input 

Jumper  to  pin  4  and  14  on 
Ul  4 

6 

Q  Output 

NC 

7 

Ground 

Ground 

8 

NC 

NC 

9 

Rint 

NC 

10 

Cext 

Jumper  to  Pin  11,  with  a  82.5  Picofarad 
Capacitor,  on  Ul 4 

11 

Rext/Cext 

Jumper  to  +5V  with  a 
13Kohm  Resistor 

12 

NC 

NC 

13 

NC 

NC 

14 

Vcc 

+5V 

74LS04  Hex   Inverters    (U15) 


b4 


Pin  Number 

Designation 

Connection  Description 

1 

Input  1A 

NC 

2 

Output  1Y 

NC 

3 

Input  2A 

NC 

4 

Output  2Y 

NC 

5 

Input  3A 

NC 

6 

Output  3Y 

NC 

7 

Ground 

Ground 

8 

Output  4Y 

Pin  6  on  U12 

9 

Input  4A 

Dip  Fin  lb  on  J 15  with 
a  IKohm  Pull  Down  Resistor 

10 

Output  5Y 

NC 

11 

Input  5A 

NC 

12 

Output  6Y 

Pin  3  on  U17 

13 

Input  6A 

Dip  Fin  y  on  Jib  with 
lOKohm  Pull  Down  Resistor 

14 

Vcc 

+5V 

74LS121  Monostable  Multivibrator  (U16)". 
with  Schmitt  -  Trigger  Inputs 
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Pin  Number 

Designation 

Connection  Description 

1 

Q  Output 

NC 

2 

NC 

NC 

3 

Al  Input 

Dip  Pin  No.  26  from 
J16 

4 

A2  Input 

Jumper  to  Pin  5  on  U16 
Which  is  Connected  to  +5V 

5 

B  Input 

Jumper  to  Pin  4  and  14  on 
U16 

6 

Q  Output 

Pin  11  on  U20 

7 

Ground 

Ground 

8 

NC 

NC 

9 

Rint 

NC 

10 

Cext 

Jumper  to  Pin  11,  with  a  82.5  Picofarad 
Capacitor,  on  U16 

11 

Rext/Cext 

Jumper  to  +5V  with  a 
15Kohm  Resistor 

12 

NC 

NC 

13 

NC 

NC 

14 

Vcc 

+5V 

74LS121  Monostable  Multivibrator  (U17) 
with  Schmitt  -  Trigger  Inputs 
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Pin  Number 

Designation 

Connection  Description 

1 

Q  Output 

NC 

2 

NC 

NC 

3 

Al  Input 

Pin  12  on  U15 

4 

A2  Input 

Jumper  to  Pin  5  on  Ul 7 
which  is  Connected  to  +5V 

5 

B  Input 

Jumper  to  Pin  4  and  14  on 
U17 

6 

Q  Output 

Pin  13  on  U10 

7 

Ground 

Ground 

8 

NC 

NC 

9 

Rint 

NC 

10 

Cext 

Jumper  to  Pin  11,  with  a  82.5  Picofarad 
Capacitorron  Ul7 

11 

Rext/Cext 

Jumper  to  +5V  with  a 
15Kohm  Resistor 

12 

NC 

NC 

13 

NC 

NC 

14 

Vcc 

+5V 

74LS373  Octal  D  -  Type  Transparent  Latches 
and  Edge  -  Triggered  Flip  -  Flops  (Ul  8) 
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Pin  Number 

Designation 

Connection  Description 

1 

Output  Control 

Pin  11   on  U 10 

2 

Data  Bit  1   Out 

DiD  Pin  1    on  J16 

3 

Data  Bit  1    In 

Pin  52  on  U21 

4 

Data  Bit  2  In 

Pin  54  on  U21 

5 

Data   Bit  2  Out 

DiD  Pin  2  on  J16 

6 

Data  Bit  3  Out 

Dip  Pin  3  on  J 1 6 

7 

Data  Bit  3   In 

Pin  56  on  U21 

8 

Data  Bit  4   In 

Pin  58  on  U21 

9 

Data   Bit  4  Out 

Dip  Pin  4  on  J 1 6 

10 

Ground 

Ground 

11 

Enable  Latch 

Pin  33  on  U21 

12 

Data  Bit  5  Out 

Dip  Pin  5  on  J16 

13 

Data  Bit  5   In 

Pin  61   on  U21 

14 

Data  Bit  6   In 

Pin  63  on  U21 

15 

Data  Bit  6  Out 

Dip  Pin  6  on  J16 

16 

Data  Bit  7  Out 

Dip  Pin  7  on  J16 

17 

Data  Bit  7   In 

Pin  65  on  U21 

18 

Data  Bit  8   In 

Pin  67  on  U2 1 

19 

Data  Bit  8  Out 

Dip  Pin  8  on  J16 

20 

Vcc 

+5V 
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74LS373  Octal  D  -  Type  Transparent  Latches 
and  Edge  -  Triggered  Flip  -  Flops  (Ul9) 


Pin 

Number 

Designation 

Connection  Description 

1 

Output  Control 

Pin  8  on  U10 

2 

Data  Bit  1  Out 

Dip  Pin  1  on  J16 

3 

Data  Bit  1  In 

Pin  71  on  U21 

4 

Data  Bit  2  In 

Pin  70  on  U21 

5 

Data  Bit  2  Out 

Dip  Pin  2  on  J16 

6 

Data  Bit  3  Out 

NC 

7 

Data  Bit  3  In 

NC 

8 

Data  Bit  4  In 

NC 

9 

Data  Bit  4  Out 

NC 

10 

Ground 

Ground 

11 

Enable  Latch 

Pin  33  on  U21 

12 

Data  Bit  5  Out 

NC 

13 

Data  Bit  5  In 

NC 

14 

Data  Bit  6  In 

NC 

15 

Data  Bit  6  Out 

NC 

16 

Data  Bit  7  Out 

NC 

17 

Data  Bit  7  In 

NC 

18 

Data  Bit  8  In 

NC 

19 

Data  Bit  8  Out 

NC 

20 

Vcc 

+5V 

74LS373  Octal  D  -  Type  Transparent  Latches 
and  Edge  -  Triggered  Flip  -  Flops  (U20) 


b9 


Pin  Number 

Designation 

Connection  Description 

1 

Output  Control 

Pin  3  on  U10 

2 

Data  Bit  1   Out 

Dip  Pin  33  on  J15 

3 

Data   Bit  1    In 

Dip  Pin   1   on  J16 

4 

Data  Bit  2   In 

Dip  Pin  2  on  J16 

S 

Data  Bit  2  Out 

Dip  Pin  32  on  J15 

6 

Data  Bit  3  Out 

Dip  Pin  31   on  J15 

7 

Data   Bit  3   In 

Dip  Pin  3  on  J16 

8 

Data  Bit  4  In 

Dip  Pin  4  on  J16 

9 

Data   Bit  4  Out 

Dip  Pin  30  on  J15 

10 

Ground 

Ground 

11 

Enable  Latch 

Pin  6  on  Ul 6 

12 

Data  Bit  5  Out 

Dip  Pin  29  on  J15 

13 

Data  Bit  5   In 

Dip  Pin  5  on  J16 

14 

Data   Bit  6   In 

Dip  Pin  6  on  J16 

15 

Data  Bit  6  Out 

Dip  Pin  28  on  J15 

16 

Data  Bit  7  Out 

Dip  Pin  27  on  J15 

17 

Data  Bit  7  In 

Dip  Pin  7  on  J16 

18 

Data  Bit  8   In 

Dip  Pin  8  on  J16 

19 

Data  Bit  8  Out 

Dip  Pin  26  on  J15 

20 

Vcc 

+5V 

ADC10Z  (U21) 
Analog  -  to  -  Digital 
Converter 
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Pin  Number 

Designation 

Connection  Description 

2 

Buffer  Input 

Analog  Signal  from  Strain  Gauges 
on  the  Flexible  Link 

3 

Buffer  Ground 

Ground 

4 

Buffer  Output 

Red  on  Potentiometer  1 

5 

+10V  or  ilOV  Input 

NC 

6 

+5V  or  ±5V  Input 

NC 

15 

Direct  Input 

Red  on  Potentiometer  2 

16 

Unipolar 

NC 

19 

Unipolar 

NC 

20 

Zero 

-15V 

21 

Bipolar 

Jumper  to  Pin  22  on  U21 

22 

Bipolar 

Jumper  to  Pin  21  on  U21 

23 

Signal  Ground 

Ground 

25 

-15V 

-15V 

26 

Serial  Out 

NC 

27 

+15V 

+15V 

29 

+5V 

+5V 

30 

Digital  Ground 

Jumper  to  Pin  23  on  U21 

32 

Clock  Rate 

NC 

33 

Status 

Pin  6  on  U16 

34 

Conversion  Command 

Pin  11  on  U18  and  U19 

35 

Clock  in 

Jumper  to  Pin  36  on  U21 

36 

Clock  out 

Jumper  to  Pin  35  on  U21 

37 

Clock  Inhibit 

Jumper  to  Pin  43  on  U21 

39 

Strobe  out 

NC 

ADC10Z  (U21) 
Analog  -  to  -  Digital 
Converter 
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Pin  Number 

Designation 

Connection  Description 

43 

Jumper  to  37 

Status 

52 

Data  Bit  0   (LSB) 

Pin  3  on  U18 

54 

Data  Bit  1 

Pin  4  on  U18 

56 

Data  Bit  2 

Pin  7  on  U18 

58 

Data  Bit  3 

Pin  8  on  U18 

61 

Data   Bit  4 

Pin  13  on  U18 

63 

Data  Bit  5 

Pin  14  on  U18 

65 

Data   Bit  6 

Pin  17  on  U18 

67 

Data  Bit  7 

Pin  18  on  U18 

70 

Pin  4  on  U19 

Data  Bit  9   (MSB) 

71 

Data   Bit  8 

Pin  3  on  111 9 

72 

Data  Bit  9   (MSB) 

NC 
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A15   A14 


A13   A12  ,  All   A10   A9   A8   A7   A6   A5   A4   A3 


v 

ABC 

Decoder  Logic 
Select  Lines 
74LS138 


J 


Chip 
Select 
Decoder 
74LS138 


Address  Counter  0 
Address  Counter  1 
Address  Counter  2 
Select  Mode  for  CO 

Pulse  Clk  High 
Pulse  Clk  Low 

Shaft  Dir.  CW 
Shaft  Dir.  CCW 

Set  Bias  S.M.D. 

Flag  2  =  Flag  1 


Memory  Map 

$0000    DFFF  External  to  ME6802D5 
$E000    E3FF  User  RAM 


15  14  13  12 

11  10  9  8 

7  6  5  4 

3  2  10 

X  0  0  0 
X  0  0  0 
X  0  0  0 
X  0  0  0 

X  0  0  1 
X  1  1  0 

X  1  0  0 
X  0  1  0 

X  1  0  1 

XXXX 

XXXX 
XXXX 
XXXX 
XXXX 

XXXX 
XXXX 

XXXX 
XXXX 

XXXX 

XXXX 

0  X  X  X 
0  X  X  X 
0  X  X  X 
0  X  X  X 

0  X  X  X 
0  X  X  X 

0  X  X  X 
0  X  X  X 

0  X  X  X 

1  X  1  X 

X  X  0  0 

X  X  0  1 
X  X  1  0 
X  X  1  1 

XXXX 
XXXX 

XXXX 
XXXX 

XXXX 

XXXI 

Register 
Select 
for  8253 


$0000 
$0001 
$0002 
$0003 

$1000 
$6000 

$4000 
$2000 

$5000 

$00A1 
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APPENDIX    B 


SOFTWARE 
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10  REM  *********»**»******+*»*»+«»**»--.^».»-  it*********************************** 

20  REM 

30  REM     RUNGE-KUT7A  SIMULATION  FOR  CONTROL  STRATEGY  IMPLEMENTED  IN  A 

40  REM     SYSTEM  TO  CONTROL  THE  MOVEMENT  OF  A  FLEXIBLE  LINK.   THE  CONTROL 

50  REM     STRATEGY  CONSISTS  3r    PROPORTIONAL  FLUS  INTEGRAL  CONTROL  WITH 

60  REM     UNITY  PLUS  DERIVATIVE  FHEBACK. 

70  REM 

80  REM  WRITTEN  BY  BOB  SIMMONS    JANUARY  1984 

90  REM 

100  REM  

UO  REM 

120  REM      THIS  PROGRAM  SIMULATES  A  SYSTEM  OF  DIFFERENTIAL  EQUATIONS  BY 

130  REM   THE  FOURTH-ORDER  RUNGE-KUTTA  METHOD.   THE  USER  MUST  SUPPLY  A 

140  REM   SET  OF  EQUATIONS  IN  STATE-VARIABLE  FORM.   THE  EQUATIONS  ARE 

150  REM   ENTERED  AS  THE  SUE-ROUTINE  Funct:  AT  THE  END  OF  THE  PROGRAM. 

160  REM 

170  REM     AN  EULER  METHOD  SIMULATION  IS  ALSO  DONE  USING  ONLY  THE  FIRST 

180  REM   ESTIMATE  OF  THE  SLOPE. 

190  REM 

20O  REM     THE  RESULTS  ARE  PRINTED  IN  THREE  COLUMNS  —  TIME,  THE 

210  REM   RUNGE-KUTTA  ESTIMATE  OF  THE  SYSTEM  OUTPUT,  AND  THE 

220  REM   EULER  ESTIMATE  OF  THE  SYSTEM  OUTFUT. 

230  REM 

240  REM   THE  VARIABLES  USED  IN  THE  PROGRAM  ARE: 

250  REM 

260  REM       N        THE  ORDER  OF  THE  SYSTEM.   THIS  IS  EQUAL  TO  THE 

270  REM  NUMBER  OF  STATE  VARIABLES. 

280  REM 

290  REM       X(N>     AN  ARRAY  HOLDING  THE  RUNGE-K'JTTA  ESTIMATE  OF 

300  REM  THE  STATE  VARIABLES. 

310  REM 

320  REM       Y<N)     A  TEMPORARY  ARRAY  USED  TO  PASS  THE  ESTIMATES  OF 

330  REM  THE  STATE  VARIABLES  TO  THE  SUBROUTINE  Funct:. 

340  REM 

350  REM       Z(N)     AN  ARRAY  USED  TO  SUM  UP  T!iH  SLOPE    ESTIMATES  IN 

360  REM  A  WEIGHTED  MANNER. 

370  REM 

380  REM        P(N)      AN  ARRAY  HOLDING  THE  feULER  ESTIMATE  CF  THc 

390  REM  STATE  VARIABLES. 

400  REM 

410  REM       H        THE  STEP  SIZE. 

420  REM 

430  REM       T        TIME. 

440  REM 

450  REM       I, J      GENERAL  COUNTERS  AND  ARRAY  SUBSCRIPTS. 

460  REM 

470  REM > 

480  REM 
490  REM 

500  REM  

510  REM 

520  REM    SPECIFY  N,  H,  AND  INITIAL 

530  REM    VALUES  OF  STATE  VARIABLES 

540  REM    HERE. . 

550  REM 

560  REM  

570  REM 

580  COM  /Aa/  H,N, X (3) , Wn ,R , Kp ,Kd ,Ki 

590  INPUT  "ENTER  KP  ?<  KD  .<<  KI  i<    K"  ,Kp  ,Kd  .Ki 

600  N=3 
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610  R-2/3 

620  INPUT  "ENTER  STEP  SIZE  H  =",H 

630  X  '.  1  >  =0 

640  Xi2>=0 

650  X<3)»0 

66>J  P  (1>»X  (1 ) 

670  REM 

630  REM       PRINT  HEADINGS 

690  REM 

700  PRINT  "  TIME      RUNGE-KUTTA  EST.     EULER  EST." 

710  PRINT  "  OFX(l)  OF  X  C 1  >  " 

720  PRINT 

770  REM 

740  REM       TOP  OF  LOOP 

730  REM 

760  GINIT 

770  GRAPHICS  ON 

730  ALPHA  OFF 

790  FRAME 

800  WINDOW  0,3,0,2 

310  AXES  . 1 ,. 1 ,0,0,10,10,3 

320  MOVE  0 . 1 

330  DRAW  3 , 1 

340  MOVE  0,0 

350  FOR  1=0  TO  1/R  STEP  H       !  LOOP  STARTS  HERE 

360  r=i 

370    PRINT    L'SING    "DDDDDDDDDDD. DDDD" ; T, X C 1 > ,P < 1 > 

88<J   REM 

390  REM       LOAD  Y  WITH  X  TO  PASS  TO  Funct: 

900  REM 

910  FOR  J=l  TO  N 

920  Y(J)=X(J) 

930  NEXT  J 

940  GOSUB  Funct 

950  REM 

960  REM       START  RUNNING  SUM  IN  2(N)  WITH  SLOPES  FROM  Funct: 

970  REM 

9S0  FOR  J=l  TO  N 

990  Z(J)=F(J) 

1000  NEXT  J 

1010  REM 

1020  REM      CALCULATE  £JLER  APPROXIMATION 

1030  REM 

1040  FOR  J=l  TO  N 

1050  P(J)=P(J) *H*F<J> 

1060  NEXT  J 

1070  REM 

1030  REM     LOAD  Y(N>  WfH  NEW  ESTIMATES  OF  X CN>  BASED  ON  FIRST 

1090  REM         SLOPE  ESTIMATE. 

1100  REM 

1110  FOR  J=l  TO  N 

1120  Y(J)»X (J)+H*F(J) /2 

1130  NEXT  J 

1140  GOSUB  Funct 

1150  REM 

1160  REM     ADD  WEIGHTED  SLOFE  TO  RUNNING  SUM 

1170  REM 

1130  FOR  J=l  TO  N 

1190  Z<J>=Z (J)+2*FtJ) 

1200  NEXT  J 
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1210  REM 

1220  REM     LOAD  Y<N)  WITH  NEW  ESTIMATES  OF  X(N)  BASED  ON  NEW 

1230  REM        SLOPE  ESTIMATE. 

1240  REM 

1230  FOR  J=l  TO  N 

1260  Y(J>=X <J)+H*F(J) /2 

1270  NEXT  J 

1280  GOSUB  Funct 

1290  REM 

1300  REM     ADD  WEIGHTED  SLOPE  TO  RUNNING  SUM. 

1310  REM 

1320  FOR  J  =  l  TO  N 

1330  Z <J)=Z <J)+2*F<J> 

1340  NEXT  J 

1350  REM 

1360  REM    LOAD  Y(N>  WITH  FINAL  ESTIMATE  OF  X(N)  BASED  ON  THIRD 

1370  REM        ESTIMATE  OF  SLOPE. 

13e0  REM 

1390  FOR  J=l  TO  N 

1400  Y(J)=X <J>+H*F<J) 

1410  NEXT  J 

1420  GOSUB  Funct 

1430  REM 

1440  REM     ADD  FINAL  SLOFE  ESTIMATE  TO  RUNNING  SUM 

1430  REM 

1460  FOR  J=l  TO  N 

1470  Z (J)-Z (J)+F(J> 

1480  NEXT  J 

1490  REM 

1500  REM     CALCULATE  NEW  VALUE  OF  X (N)  USING  WEIGHTED  AVERAGE 

1510  REM         SLOPE. 

1520  REM 

1530  FOR  J-l  TO  N 

1540  X(J)=X (J) +H*Z (J) /6 

1550  NEXT  J 

1560  DRAW  T+H,X<1> 

1570  MOVE  T.Thc-H*R 

1580  DRAW  T+H,Thc 

1590  HOVE  T+H.X (1) 

1600  NEXT  I 

1610  INPUT  A 

1620  1DUMP  GRAFHICS 

1630  !GCLEAP 

1640  LOAD  "C0NT51" 

1650  STOP 

1660  REM 

1670  REM         DEFINE  STATE  EQUATIONS  HERE 

1630  REM 

1690  Funct: Thc=R*T 

1700        Wn^=7 

1710        F(l)=Y(2)-Krp*Kd*Wn*Wn*Ya)  -  SYSTEM  EQUATIONS  IN 

1720        F(2)=Kp*Wr!*Wn*Thc-Wn*Wn*( 1+Kp+Ki *Kd) *Y < 1 > +Y (3)      '    STATE  VARIABLE 

FORM 

1730       P<3)»Wn»Wn*Ki*<Thc-YC> ) 

1740         PETURN 
1 750        END 
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10  COM  /Aa/  H.N.X (3)  ,Wn,R,Kp,Kd,Ki 

20  PRINT  Ze. H.N.X  (  I)  ,X  '.2)   ,  Wn 

30  P(1)=X (1) 

40  REM 

50  REM       TOP  OF  LOOP 

60  REM 

70  FOR  1=1 /R  TO  5  STEP  H        !  LOOP  STARTS  HERE 

ao    t=i 

90   PRINT  USING  "DDDDDDDDDDD. DDDD" ; T  ,  X  (  1 )  ,P  ( 1 ) 

100  REM 

110  REM       LOAD  Y  WITH  X  TO  PASS  TO  Funct: 

120  REM 

130  FOR  J=l  TO  N 

140  Y(J)=XCJ> 

150  NEXT  J 

160  GOSUB  Funct 

170  REM 

ISO  REM       START  RUNNING  SUM  IN  Z(N)  WITH  SLOPES  FROM  Funct: 

190  REM 

200  FOR  J=l  TO  N 


210 

Z<J>< 

»F(J) 

220 

NEXT 

J 

230 

REM 

240 

REM 

CALCULAT 

250 

REM 

260 

FOR  , 

J-l  TO  N 

270 

P(J) 

»P(J>  i-H*F(J> 

2S0 

NEXT 

J 

290 

REM 

300 

REM 

LOAD  Y(N) 

310 

REM 

SLOPE 

320 

REM 

WITH  NEW  ESTIMATES  OF  X (N)  BASED  ON  FIRST 


330  FOR  J=l  TO  M 

340  Y(J)=X (J)+H*F(J) /2 

350  NEXT  J 

360  GOSUB  Funct 

370  REM 

380  REM     ADD  WEIGHTED  SLOPE  TO  RUNNING  SUM 

390  REM 

400  FOR  J=l  TO  N 

410  Z(J)=>Z(J)+2*F(J) 

420  NEXT  J 

430  REM 

440  REM     LOAD  Y(N)  WITH  NEW  ESTIMATES  OF  X CN)  BASED  ON  NEW 

450  REM        SLOPE  ESTIMATE. 

460  REM 

470  FOR  J=l  TC  N 

480  Y(J)=X (J)+H*F(J) /2 

490  NEXT  J 

500  GOSUB  Funct 

510  REM 

520  REM     ADD  WEIGHTED  SLOPE  TO  RUNNING  SUM. 

530  REM 

540  FOR  J=l  TO  N 

550  Z (J)=Z <J>+2*F<J> 

560  NEXT  J 

570  REM 

530  REM    LOAD  Y(N)  WITH  FINAL  ESTIMATE  OF  X(N)  BASED  ON  THIRD 

590  REM        ESTIMATE  GF  SLOPE. 

£00  REM 
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610 

FOR  J=l  TO  N 

620 

Y(J)=X (J) +H*F(J) 

630 

NEXT  J 

640 

GOSUB  Funct 

630 

REM 

660 

REM     ADD  FINAL  SLOFE  ESTIMATE  TO  RUNNING 

670 

REM 

680 

FOR  J=l  TO  N 

690 

Z(J)=Z<J)+F(J) 

700 

NEXT  J 

710 

REM 

720 

REM     CALCULATE  NEW  VALUE  OF  X (N)  USING  14 

730 

REM         SLOPE. 

740 

REM 

750 

FOR  J=»l  TO  N 

760 

X (J)»X<J) +H*Z (J) /6 

770 

NEXT  J 

780 

DRAW  T+H,X(l) 

790 

NEXT  I 

800 

LDIR  0 

S10 

CSIZE  3,1 

820 

MOVE  .50,. 7 

830 

LABEL  "INPUT" 

840 

MOVE  1 . 20 , . 5 

850 

LABEL  "RESPONSE- 

860 

MOVE  2. 1 , 1.01 

870 

LABEL  "DESIRED  DISPLACEMENT" 

880 

MOVE  . 7 , 1 . 85 

890 

LABEL  "OUTPUT  RESPONSE  TO  A  RAMP  INPUT" 

900 

INPUT  A 

910 

!DUMP  GRAPHICS 

920 

GCLEAR 

930 

STOP 

940 

REM 

950 

REM         DEFINE  STATE  EQUATIONS  HERE 

960 

REM 

970 

Funct:  Thc=l 

930 

F< 1)=Y <2>-Kp*Kd*Wn*Wn»Y< 1 ) 

990 

F(2)=Kp*Wn»Wn*Thc-Wn*Wn*( l*Kp+Ki*Kd> 

FORM 

1000 

F (3>=Wn*Wn*Ki*(Thc-Y< 1) ) 

1010 

RETURN 

1020 

END 

SUM 


WEIGHTED  AVERAGE 


SYSTEM  EQUATIONS  IN 

STATE  VARIABLE 
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r.0 

70 

BO 

90 

1 00 

110 
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160 

170 

1B0 

190 

200 
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12 

220 

14 

230 

I  1 

240 

12 

250 
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13 
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12 
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THIS  PROGRAM  PLOTS  THE!  MICRO-STEP  SI /J      ■/<.  MICRO-STEP. 
THE  NUI1BE.K  OF  SAMPLES  rAKEN  FUR  THISd  PROGRAM  IS  ElfciKI  . 
ALSO  THE  HUM  OF  THE  DISTANCES  DP  EACH  SET  OF  MICRO-STEPS 
IS  FOUND  TO  FIND  THE  DEVIATION  OF  THE  SIZE  OF'  EACH  SET  UP 
MICRO-STEPS.   THE  AVERAGE,  OF  THE  SIZES,  OF  ALL  SETS  OF 
MICRO-STEPS  IS  FOUND  ALONG  WITH  THE  AVERAGE  OF  EACH 
INDIVIDUAL  MICRO-STEP.   THE  DEVIATION  OF  EACH  MICRO  1st, 
2nd,  3rd  ETC.  IS  FOUND  FROM  THE  EIGHT  SAMPLES  TAKEN. 

writ  lei  i  by;  BOH  SIMMONS 

*♦***#*#*»***********#»********■*#**»*•*************«************* 
OPTION  BASE  1 

DIM  Af  r&y<48,8)  ,Sums(B>  ,Arr_dvg<48>  .AvgiB)  ,M*x_dev<8>  ,  Max  _de  v2'  <  9 ) 
DIM  Arr.avijl  (48,8)  ,  Arr  _«vy3  (48)  , Arr  _avg5 (43) 
DATA  3,3,3,4,3,3,4,3,5,5,5,5,5,6,5,5,6,6,7,6,6,6,6,6 
D  AT  A  7  , 0  ,  7  ,  7  ,  7  ,  7  ,  6  ,  7  , 3  ,  3  ,  8  ,  8  ,  8  ,  i i ,  7  ,  8  ,  H  ,  9  ,  B  ,  7  ,  S  ,  3  ,  B  ,  3 

DATA  9.11,9,8,10,10,9,8,0,11  ,10,10,9,10,9,9,10,  11,11,  1  1  ,l'M0,ll,10 
DATA  9,12,11,12,11,10,10,9,10,13,11,12,10,12,11,10,10,12,12.12,1  1,11,11 
DATA  1 1 , 1 2 , 1 3 , 1 3 , 1 2 , 1 0 , 1 3 ,  1  1  , 1 2 , 1 4 , 1 2 ,  1 4  ,  1  1  ,  1 2 , 1 3 , 1 2 , 1 2 , 1 3 , 1 3 , 1 4 , 1 3 , 1 1 

DATA  12,14,14,13,12,12,13,14,12,15,15,14,13,14,14,14, 12, 15, 15,15,14,14 

DA  I  A  1 3,13, 16,1 5, 14,13,1 4,14,1 3,13, 15,1 2, 13, 13,14, 13,1 3, 13, 11, 15,1  1  ,11 

DATA  13,10,14,14,12,13,13,14, 11 ,13,14, 12,12,14,13,13,10,10,  10,11  ,10,10 

DATA  10, 12, 10, 1 1 , iO, 10, 10, 12, 10, 1 3 , 12 , i 2 , 12 , 1 3 , 12 , 13 , 1 2 , 12 , 13, 12 , 1 1 , 12 

DATA  12,13.  li  ,15,14,1  I  ,12,14,13,13,15,12,12,13,13,14,  i3, 13,  16.1  5,  14,13 

DATA  14, 15,15,15,lo,15, 14,15,14,15,15, 14,15,15,14, 14,14,14,14,13,14,14 

DA  I  A  13,13,13,11,13,14,14,13,13,13,13,13,13,13,13,14,12,12,1  .,  ,12,12,13 

DATA  13,12,12,11,13,12,11,11,12,11,12,11,11,12,12,11,11,10,12,10,11,11 

DATA  1 1 , 1 0 , 1 1 , 9 , 1 1 , 1 2 , 1 1 , 1 O , 1 O , 1 O , 9 , 9 , 1 O , 1 O , 9 , 9 , 1 0 , G , 9 , 0 , 9 , V , 1 O , V 
DATA  9 , 8 , B , S , 8 , 3 , 8 , 3 , 7 , 8 , 8 , 7 , 9 , 3 , 7 , 7 , 7 , 3 , 7 , 3 , 7 , 8 , 7 , 7 
DATA  6  , 5  , 6  ,  4  , 6  ,  6  , 5  , 4  , 5  ,  4  ,  5  ,  4  ,  5  ,  5  ,  4  ,  4  , : r. ,  3  ,  3  ,  3  ,  3  ,  3  ,  3  ,  3 
READ  Array!*) 

PRINT  "1st    :    2nd    :    3rd    :    4th    :    5th    :    6t.h    :    7th 
3th" 

PRINT  Ar  ray (*) 

PRINT  CHR*( 12) 

PRINT 

PRINT 

PRINT  "LFNGTH  OF  EACH  SET  OF  MICRO-STEPS  IN  32nds  OF  AN  INCH  AND  THE" 

PRINT  "AVERAGE  MICR0-3TEP  IN  THAT  SET." 

PRINT  " " 

FOR  1=1  TO  8 

Sums ( I ) -  0 

FOR  J  =  l  TO  48 

Sums.  ( I  )  'Suns  ( 1 )  +Array  ( J  ,  I ) 

NEXT  .( 

PRINT  "SAMPLE  ";I 

PRINT  "SUM  OF  MICRO- STEPS  -  " jSums(I) 

Avg  (  1  )=Sitins<  I)  /4B 

PR  I  NT  "MI CKO-BTEP_AVG  ==  "  ;  Ayy  (  I  ) 


1,11 

i  12, 

,  15, 

.  12* 

,  11  . 

,  13, 

,13, 

,13, 

,  1 3 , 

,  i  :s , 

72 


3 1 0  PR  I  NT 

320  NEXT    I 

530  PRINT 

540  Suimn=0 

330  FOR    K=l     TO    a 

360  Buimii- Sumin+ourni  (K) 

5  70  NEXT    K 

330  Sumn»_avy  ~  Sumin/S 

SSO  PRINT    "AVERAGE    Of    ALL.    THE    SETS    (JP    MICRO-STEPS    =-     ";Sunmi    tlvit 

6u0  PRINT 

610  FDR    1"1     TO    b 

6^i)  Max_dtsv<I> -ABS<Summ_avq-Sums<  I)  ) 

630  IF    I1a;:_dev  (  I  )  >l-U..-:_  devl     THEN    GOTO    65o 

640  GOTO    660 

630  Ma::     devl-Ma:;     diiv  <  I  ) 

660  NEXT     I 

<S70  PRINT    "MAXIMUM    DEVIATION    FROM    THE    AVERAGE    SET    OF    MICRO-STEPS    -    ";Max    df>vl 

600  PRINT 

690  Max_dev2<l)*0 

700  FUR    I  ==2    TO    9 

7  l  0  Ma::  _dev  2  <  I  )  "Max    de\'2  (  I  - 1 )  +Ma>:  _dev  (  I  - 1  ) 

720  NEXT    I 

730  Mti>;  _dev3-*Max  _dev2  ( 8 )  /  B 

740  PRINT    "AVERAGE    DEVIAIION    FROM    THE    AVERAGE    SET    OF    MICRO-STEPS    -    ";Ma>     dev". 

7rj0  PRINT    CHR*(12) 

760  FOR    J-1     10    48 

770  Arr_avg<J>-0 

780  FOR    1=1    TO    8 

790  Arr_avg (J) =Arr  avg ( J ) +Ar r ay ( J , I ) 

800  NEXT  1 

810  Ar  r_avg  <J)=Arr_avg  (J  )  /ti 

820  NEXT  J 

830  PRINT  "AVERAGE  UF  EACH  MICRO-STEP  FROM  LEFT  TO  RIGHT  .*<  TOP  TO  BOTTOM" 

840  PR  I  NT  " „ 

800  PR  I N  T  Ar r  _a vg  ( * ) 

860  PRINT 

870  PRINT 

380  FOR  1=2  TO  49 

890  Arr_«vy^O 

900  FOR  J- I  TO  3 

910  Ar  r  ..avg  i  <  1  - 1  ,  J  )  ~ABS  ( Arr  ay  (  I  -  1  ,  j  )  -Arr  _«.  vq  ( I- 1  )  ) 

920  IF  ftrr  _avgl  U-1,J)  >Arr  svu2  THEN  GOTO  940 

930  GOTO  950 

940  Arr_avg2--Arr__avg  I  (1-1  ,J) 

9GO  NEXT  J 

960  Arr  _avyo(I-l  >=Arr._avy2  !  MAX  DEVIATION  FROM  AVERAGE  MICRO-STEP' 

970  NEXT  I 

980  PRINT  "MAXIMUM  DEVIATION  FROM  THE  AVERAGE  MICRO-STEP  FROM  LEF 1  TO  RIGHT" 

990  PRINT  "  i<    TOP  TO  BOTTOM" 

1000  PRINT  " ., 

lOlO  PRINT    Arr _avg3 ( « ) 

1020  FOR    1^1     TO    48 

1030  Ar  r_avg 4=0 

1040  F0R~J=1    TO    3 

1030  Arr  _avg4-Ar  r__avu4<  Arr     avg  1  (  I  ,  J  ) 

1060  NEXT    J 

1070  Ar  r  _av<.j5  <  I  > -Arr  avg4/8 

1080  NEXT  I 

1090  PRINT 

1  1 00  PR 1  NT 


73 


J  110  PRINT  "AVERAGE  DEVIATION  F  RUM  I  I  IE  AVfcRAlit  MICRO  STEP  FROM  LE'F'1   It)  RIliHT' 

1120  PRINT  "  &  1'uP  ro  BOTTOM" 

1140  PRINT  Arr„.avg5(*) 

1  ISO  C.I  MIT 

1 160  GRAPHICS  ON 

I  1  ,'0  ALPHA  OFF' 

I I  SO  W 1 NDCW  -10, 30 , -  1 0 , HO 
1  1 90  AXES  1,1,0, 0 ,  S ,  5 ,  6 

1 200  FRAME 

1210  Mstfep-0 

1220  FUR  1-1  TG  48 

1 2-SO  Ms.tep-Ms.tep  +  1 

1240  MOVE  Ms  I  *p  - .  3  .  Ar  r    avg  •.  I )  - .  3 

1250  I  DRAW  .6,. 6 

1260  MOVE  M&tep-.3,Arr_avy (I) +.3 

1270  1DRAW  .6, -.6 

1  280  NE  X 1  I 

1290  LDIR  0 

130O  MOVE.'  4.5,-5 

1310  LABEL  "5   10   15   20   25  30   35  40   45" 

1320  MUVE  4,-9 

1330  LABEL  "  MICRO-STEP" 

1340  MOVE  -7,8.5 

1350  LABEL  ".036" 

1360  MOVE  -7,13.5 

1370  LABEL  ".072" 

13SO  MOVE  -7,23.5 

1390  LABEL  ". 108" 

1400  MOVE  -7,38.5 

14  10  LABEL  ".144" 

1420  LDIR  PI/2 

1430  MOVE  -7  ,  It.) 

1440  I.ABEl.  "    DELTA  THETA  (DEG)" 

1450  INPUT  X 

1460  PRINT  CHR*(12> 

14  70  DUMP  GRAPHICS 

14  30  GIXEAR 

1490  END 
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LENGTH  OF  EACH  SET  OF  MICRO-STEPS  IN  32nds  OF  AN  INCH  AND  THE 
AVERAGE  MICRO-STEP  IN  THAT  SET. 

SAMPLE   1 

SUM  OF  MICRO-STEPS  =   491 

MICRO-STEP_AVG  =   10.2291666667 

SAMPLE   2 

SUM  OF  MICRO-STEPS  =   519 

MICRO-STEP_AVG  =   10.8125 

SAMPLE   3 

SUM  OF  MICRO-STEPS  =   526 

MICRO-STEP_AVG  =   10.9583333333 

SAMPLE   4 

SUM  OF  MICRO-STEPS  =   516 

MICRO-STEP_AVG  =   10.75 

SAMPLE   5 

SUM  OF  MICRO-STEPS  -   504 

MICRO-STEP_AVG  =   10.5 

SAMPLE   6 

SUM  OF  MICRO-STEPS  =   507 

MICRO-STEP_AVG  =   10.5625 

SAMPLE   7 

SUM  OF  MICRO-STEFS  =   507 

MICRO-STEP_AVG  =   10.5625 

SAMPLE   8 

SUM  OF  MICRO-STEPS  =   501 

MICRO-STEP_AVG  =   10.4375 

AVERAGE  OF  ALL  THE  SETS  OF  MICRO-STEPS  =   508.875 

MAXIMUM  DEVIATION  FROM  THE  AVERAGE  SET  OF  MICRO-STEPS  =   17.875 

AVERAGE  DEVIATION  FROM  THE  AVERAGE  SET  OF  MICRO-STEPS  =   7.609375 


AVERAGE 

OF 

EACH  MICRO-STEP  FROM  LEFT 

TO 

RIGHT  & 

TOP  TO  BOTTOM 

3.  25 

5.  125 

6.  125 

7 

7.875 

0.25 

9.25 

9.5 

10.5 

10.5 

1 1 . 1 25 

1  1.25 

11.875 

12.5 

12.5 

13 

13.875 

14.25 

14 

13.25 

12. 123 

12.875 

12.73 

10.5 

10.623 

12 

12. 125 

12.75 

13. 125 

13.75 

14.875 

14.5 

13.625 

13.375 

13. 125 

12.375 

11 .875 

11.5 

1  1 

10.62 

9.5 

9 

8.  125 

7.625 

7.375 

5.25 

4.5 

3 

75 


MAXIMUM  DEVIATION  FROM  THE  AVERAGE  MICRO-STEP  FROM  LEFT  TO  RIGHT 
i,    TOP  TO  BOTTOM 


.75 

.875 

.875 

1 

.875 

.75 

1  .  75       1 

.5 

1.5 

1.875 

1.25 

1.875 

1.5 

1.5        1 

1.875 

2.  25 

2 

1.75 

2.875 

2.875 

1.75       1 

1.375 

2 

1.  125 

2 .  25 

1.875 

2.  25 

1 .  1 25 

.625 

.625 

.875 

.625 

1.  125 

.  5 

1          1 

.5 

1 

.875 

1.375 

.  625 

1.25 

.5         0 

.6: 


AVERAGE  DEVIATION  FROM  THE  AVERAGE  MICRO-STEP  FROM  LEFT  TO  RIGHT 
&  TOP  TO  BOTTOM 


.375 

.21875 

.21875 

.23 

.21875 

.375 

.8125 

.75 

.5 

1 

. 90625 

.  5625 

. 90625 

.875 

.75 

.75 

.6875 

.75 

.75 

.625 

1. 15625 

.9375 

.8125 

.625 

.78125 

.5 

.  4375 

1.25 

.6875 

.  9375 

.4375 

.5 

.46875 

. 46875 

.21875 

. 46873 

. 65625 

.5 

.71873 

.5 

.5 

.21875 

.625 

.46875 

.75 

.5 

0 

Eight  Sets  of  Data  for  Testing 
Operation  of  Micro  -  Stepper 
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St 

2nd    : 

3rd    : 

4th 

5th    : 

6th    : 

7th    : 

8th 

3 

3 

3 

4 

3 

W 

4 

3 

5 

5 

5 

5 

5 

6 

5 

5 

6 

6 

7 

6 

6 

6 

6 

6 

7 

a 

7 

7 

7 

7 

6 

7 

8 

a 

a 

a 

a 

a 

7 

8 

8 

9 

a 

9 

a 

a 

a 

8 

9 

i  i 

9 

a 

10 

10 

9 

8 

8 

n 

10 

10 

9 

10 

9 

9 

10 

u 

u 

n 

10 

10 

11 

10 

9 

12 

u 

12 

1  1 

10 

10 

9 

10 

13 

n 

12 

10 

12 

11 

10 

10 

12 

12 

12 

1  1 

11 

11 

1  1 

1  1 

12 

13 

13 

12 

10 

13 

11 

12 

14 

12 

14 

11 

12 

13 

12 

12 

13 

13 

14 

13 

11 

12 

12 

12 

14 

14 

13 

12 

12 

13 

14 

12 

15 

15 

14 

13 

14 

14 

14 

12 

15 

15 

15 

14 

14 

15 

14 

13 

13 

16 

15 

14 

13 

14 

14 

13 

13 

15 

12 

13 

13 

14 

13 

13 

13 

11 

15 

11 

11 

12 

11 

13 

10 

14 

14 

12 

13 

13 

14 

11 

13 

14 

12 

12 

14 

13 

13 

10 

10 

10 

1  1 

10 

10 

11 

12 

10 

12 

10 

1  1 

10 

10 

10 

12 

10 

13 

12 

12 

12 

12 

12 

13 

12 

12 

13 

12 

11 

12 

13 

12 

12 

13 

11 

15 

14 

11 

12 

14 

13 

13 

15 

12 

12 

13 

13 

14 

13 

13 

16 

15 

14 

13 

13 

13 

14 

15 

15 

15 

16 

15 

14 

15 

14 

15 

15 

14 

15 

15 

14 

14 

14 

14 

14 

13 

14 

14 

13 

13 

13 

13 

13 

14 

13 

14 

14 

13 

13 

13 

13 

13 

13 

13 

13 

14 

12 

12 

13 

12 

12 

13 

13 

12 

13 

12 

12 

1  1 

13 

12 

11 

11 

12 

11 

12 

11 

11 

12 

12 

11 

11 

10 

12 

10 

11 

11 

12 

U 

11 

10 

11 

9 

11 

12 

1  1 

10 

10 

10 

9 

9 

10 

10 

9 

9 

10 

8 

9 

a 

9 

9 

10 

9 

9 

a 

3 

8 

a 

a 

8 

a 

7 

a 

a 

7 

9 

a 

7 

7 

7 

8 

7 

a 

7 

a 

7 

7 

6 

5 

6 

4 

6 

6 

5 

4 

5 

4 

5 

4 

5 

5 

4 

4 

3 

3 

3 

3 

3 

3 

3 

3 

10 
20 
30 

40 

so 

60 

70 
00 
90 
100 

no 

120 
150 
160 
170 
171 
173 
174 
175 
176 
180 
190 
200 
210 
220 
23C 
240 
250 
260 
270 
280 
290 
300 
310 
320 
330 
EI" 
340 
350 
360 
370 
380 
390 
40u 
410 
420 
430 
440 
450 
460 
470 
480 
490 
500 
510 
520 
530 
531 
540 
550 


PRINT  "»**#« 
PRINT  "*#«* 
PRINT  "#**♦ 
PRINT  "»»*« 
PRINT  "#««* 
PRINT  "»*»* 
PRINT  "*#*«■ 
PRINT  "**** 
PRINT  "**** 
PRINT  "***** 
PRINT 
PRINT 

OPTION  BASE 
DIM  Am (20) ,  A 
DIM  Yi (2) ,Sm 
GINIT 

GRAPHICS  ON 
ALPHA  OFF 
W I NDOW  0,10, 
AXES  . 1  ,  .  1  ,0 

REM   V(I,J>= 
REM   BM  < I , J ) 
RUM   TH(I,J) 
REM   Y(I,J)= 
! *********** 
Thi (1 >=0. 
Tht <2>  =  1 
Yi (1 )=1 
Yi  <2)=0. 
H=.2921 
N»9 
Ws=0 
Dw=.5 
Wf  =  10 
PRINT  "  mass 


THIS  PROGRAM  DETERMINES  THE  RESONANCE  FREQUENCY  ****" 

OF  THE  DIFFERENT  MUDES  01  VIBRATION  FOR  A  »*•♦'• 

UNIFORM  BEAM  WITH  A  LUMPED  MASS  AT  THE  FREE  ***»" 

END  OF-  A  CANTILEVER  BEAM.    THIS  PROGRAM  USES  A  *»**•• 

LUMPED  MASS  ANALYSIS  DFVFIOPFD  BY  MYKLESTAD ' s.  «♦**" 

written  by:  BOB  SIMMONS  *#**" 


1 

1  (2CD  ,V(20,2)  , Bm<20,2)  ,Th (2o,2)  ,Y(20,2)  ,Thi  (2) 
(20)  ,Sv (20)  ,Dv (20)  ,S1  op (20) 


— '  %<- 

,  o , io, i  <  j , a 

SHEAR  AT  SECTION  I  DUE  TO  INITIAL  CONDITION  J 
=  BENDING  MOMENT  AT  I  DUE  TO  INIT.  COND.  J 
=  SLOPE  AT  I 

DEFLECTION  AT  I 

!  INITIAL  SLOPE 
!  INITIAL  SLOPE 
'  INITIAL  DEFLECTION 

INITIAL  DEFLECTION 

LENGTH  OF  BEAM  (METERS)    11.5  INCHES 

NUMBER  SECTIONS 

STARTING  W 

DELTA  W 

ENDING  W 

1/EI  1^2/EI 


1~3/ 


CALL  Vib (Am<*> ,A1 (*) ,Ei ,N,Ws,W+ ,Dw,Sm(*> ,Sv(») ,Dv(») ,H) 

W=Ws 

PRINT  "  W  DEFL" 

'****♦**»♦»«*»»«»    LOOP  FOR  INIT.  COND    ***********»****♦»»*♦*« 

FOR  J»l  TO  2 

Th(l , J)=Thi  (J) 

Y(  1  ,J>.  =  Yi  (J) 

V(1,J)=0. 

Bm( 1 , J)=0. 

!***#»*»***«*♦#♦    LOOP  FOR  LUMPED  MASSES    **■**»**♦*♦»****♦*#♦*» 

FOR  1=2  TO  N 

V  (  I  ,  J  )  =V  ( I  - 1  ,  J  )  -Am  (  I  - 1  >  *W*W* Y  (  I  - 1  ,  J  ) 

Bm ( I , J ) =Bm ( I - 1 , J ) -V ( I , J ) *AI ( I - 1 > 

Thd  ,J)=Th  (1-1  ,  J)+Bm<  I  ,J)  »Sm(I-l  ) +V  ( I  ,  J)*Sv(I-l) 

Y(I,J)=Y(I-1 ,J)+Th( 1-1 ,J)»A1 <I-l)+Bm(I , J ) »Sv ( I - 1 ) +V ( I , J ) *Dv ( I -1 ) 

NEXT  I 

NEXT  J 

Slope=-Th  (N,l)/Tri(N,2) 

De-f  1=Y(N,  l)+Y(N,2)*SIope 

!   PRINT  W,Defl 

DRAW  W,Defl 

W=W+Dw 

IF  W<W*  THEN  370 


551  FRAME 

553  UEG  '° 

554  CSIZE  4, .8 
535  MOVE  .9, -.5 

556  LA&EL.  "1    2    3    W  (r  ad  /sec)   7" 

337  LDIR  90 

558  MOVE  .7,-3.3 

339  LABEL  "DEFLECTION" 

560  INPUT  A 

561  PRINTER  IS  701 

562  DUMP  GRAPHICS 

563  GCLEAR 

564  END 

570  SUB  Vib (Am(») ,A1 <») ,Ei ,N,Ws,Wf , Dw , Sm ( » ) , Sv (•) ,Dv(») ,H> 

571  ! »•••«#••••*•••*••**•»*•••*•*•»#••*•»**»*•••••••••«#••••»»*•••••• 

572  REM  Aid's  ARE  THE  LUMPED  MASSES  STARTING  FROM  THE  FREE  END 

573  REM  Al's  ARE  THE  LENGTHS  OF  THE  SECTIONS  OF  THE  BEAM 

574  !  *****♦***»*«**#**•**«*#«*•«•♦*««*#»*******#»***■»*#**♦«»*»**»*♦**#» 
5SO  M=N-1 

590  FOR  K=«l  TO  M 

600  Am<l)».2+.021/ < <N-1)»2> 

610  FOR  Q«2  TO  N-l 

620  Am(Q)«.021/(N-l> 

630  NEXT  Q 

640  Al (1)=H/ (N-l) 

650  FOR  0=2  TO  N-l 

660  Al <Q)=H/ (N-l) 

670  NEXT  Q 

680  Ei=. 08207* lOA0 

690  Sm<K)=Al  (JO  /Ei 

700  Sv(K)=Sm(K> *A1 (K> /2. 

710  Dv(K)=*Sv<K)  *A1  (K)*2. /3. 

720  PRINT  USING  "K , 12X , SD. 5DE , 7X , SD. 5DE , 10X , SD. 5DE" ; Am <K> , Sm (K) ,Sv (K) , Dv (K> 

730  NEXT  K 

740  PRINT 

750  PRINT 

760  !*#»**•*♦»*******•»•»#*»»*»***#*»»*#♦*♦»»«♦****»»♦»*»»*»*,,»*»»** 

770  REM    SM«  SLOPE  DUE  TO  MOMENT 

780  REM    SV=  SLOPE  DUE  TO  SHEAR 

790  REM    DV=  DEFLECTION  DUE  TO  SHEAR 

800  ! ******»***♦*#****♦«**»»***«*******#■«»♦»*»**##♦*##♦♦»♦»»*»«**** 

810  SUBEND 


X  ■****  *  ■?:;<:  '  '*:    K    ;'    •;      ■:■  ■      w-  ;r  -V.  >.  -■<■■  ■*  ;■■■    '■■■■  ■>  ■  -y:  ~  4-  p-  -?■•    \-  •*-  V-  ?■■?-  :.:-  ,■    :■■  ■■/■■  ■>:■  ■*■  ^-  V  ££.  ;.    .^  :{.  .tf.  ^    £  .J<. .?:.  g.  £.  -$.  .*  jt  :fi.  .#.  ^- 

it-  ***  **** 

THIS  PROGRAM  DETERMINES  THE  RESONANCE  FREQUENCY   **#* 

or  i in:  difffrfni"  modes  of  vt drat  ion  for  a       **•** 

UN]  HORN    HEAI1    WMil    A    LUI'll-  I   P    MASS    Al      I  HI..     FREE  *#** 

END    01      A    CAN  I  ILL  VEX    Ul  A!  L         I  I  I  I.  J    IKUtiRAI'l    USES  A           it*** 

!  UNFED    MASS    AIIAI   VSI.S    Ml  "!  :.  OFi  h    FY    NYI  LESTAD.  *-*** 

wri.tr.ten    by:     l-i'-'d    SIMMONS  ###* 

*  *  *  * 

.),.  .,,..  ..,.  ),..  „;  ,.j. .,,.  £  i, .  ,,.  £ .,,.  ,,.  „;.  ... .,,:.  .».  *.  g  .£  .,t  .>;.  .£.  .£  K.  £  £  £  #  .£  .£ ^. 


X  *** 

X-  *  *  * 

**  r-  !- 

*  K  *■* 
K  H  ■)!  ♦. 

fr  #  *  ;'.- 

*  *  s-  * 

****K  *  ***K  *  ******  K  *  h.  )■;•  !■  *  >•.  *■* 
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lass 

I /EI 

F3/EI 

MM  I'M! 

M.44395E-01 

<-3.!2211E-03 

M.97706E-0 

002625 

♦4.44895E-01 

t8.12211E-03 

+1.97706E-04 

002625 

M.44895E-0I 

+3. 1221 1E-03 

+1.97706E-04 

002625 

M.44895E-0J 

+3.12211E-03 

+1.97706E-04 

M.44895E-01 

+8.12211E-03 

+1.97706E-04 

002625 

+4.44895E-01 

+8.12211E-03 

+1.97706E-04 

002625 

M.44895E-01 

♦8. 12211E-03 

M.97706E-04 

002625 

M.44895E-01 

*8. 12211E-03 

+1.97706E-04 

1 

1.5 

2 

2.5 

3 

3.5 

4 

4.5 

5 

5.5 

6 

6.5 

7 

7.5 

8 

8.5 

9 

9.5 

10 

10.5 

11 

11.5 

12 

12.5 

13 

13.5 

14 

14.5 

15 

DEFL 
I 

.99473379376! 

.97395976911 

.952676699333 

.915912510247 

.363699235323 

.311077956281 

.743093713877 

.664320441674 

.576310300637 

.477646100439 

.363911129462 

.250198999479 

.121610970583 

-.0167437330219 

-.164748150729 

-.322277751043 

-.439200709171 

-.665373120936 

-.350664257216 

-1.04490682312 

-1.24794722603 

-1.4596203517 

-1.67975734756 

-1.90818091226 

-2.14471059074 

-2.33916057382 

-2.64134050151 

-2.90105576915 

-3.16810783554 

-3.44229453226 
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CONTROL  OF  A  FLEXIBLE  LINK 
USING  A  MICRO  STEPPER  MOTOR 
WITH  ACCELERATION  FEEDBACK 


ABSTRACT 


A  low  mass  flexible  link  is  one  requirement  of  a 
manipulator  arm  for  use  in  space  investigations.  ft  control 
system,  consisting  of  a  stepper  motor,  a  stepper  motor 
circuit,  and  strain  gauges,  was  developed  to  control  the 
angular  displacement  of  a  low  mass  flexible  link.  The 
control  strategy  was  a  proportional  plus  integral  control 
with  unity  plus  derivative  feedback.  The  position  of  the 
flexible  link  was  determined  by  a  set  of  strain  gauges  which 
provided  an  acceleration  feedback  signal  to  the  MC68000 
microcomputer.  In  addition,  a  micro  stepper  circuit  was 
developed  to  improve  the  resolution  and  smoothness  of  the 
motion  of  the  flexible  link.  This  was  achieved  by  regulating 
the  current  through  the  stepper  motor  fields.  Pulse  width 
modulation  using  three  programmable  counters,  provided  1  to 
50  usee.  pulses  to  the  stepper  motor.  The  electrical 
features  of  the  stepper  motor  filtered  these  pulses  to 
provide  a  regulated  current  to  the  electrical  field  and 
therefore,  generated  a  proportional  force  to  the  armature  of 
the  stepper  motor.  The  magnitude  of  the  force  determined  the 
placement  of  the  flexible  link.  The  control  system  permitted 
the  flexible  link  to  be  positioned  within  ±  0.  076  degrees. 


